Lines Matching +full:chip +full:- +full:to +full:- +full:chip
1 // SPDX-License-Identifier: GPL-2.0
9 * - completely revamped method functions so they are aware and
11 * - scalability vs code size is completely set at compile-time
13 * - optimized write buffer method
14 * 06/21/2002 Joern Engel <joern@wh.fh-wedel.de> and others
15 * - modified Intel Command Set 0x0001 to support ST Advanced Architecture
17 * - added a writev function
18 * 07/13/2005 Joern Engel <joern@wh.fh-wedel.de>
19 * - Plugged memory leak in cfi_staa_writev().
41 unsigned long count, loff_t to, size_t *retlen);
69 printk(" Feature/Command Support: %4.4X\n", extp->FeatureSupport); in cfi_tell_features()
70 printk(" - Chip Erase: %s\n", extp->FeatureSupport&1?"supported":"unsupported"); in cfi_tell_features()
71 printk(" - Suspend Erase: %s\n", extp->FeatureSupport&2?"supported":"unsupported"); in cfi_tell_features()
72 printk(" - Suspend Program: %s\n", extp->FeatureSupport&4?"supported":"unsupported"); in cfi_tell_features()
73 printk(" - Legacy Lock/Unlock: %s\n", extp->FeatureSupport&8?"supported":"unsupported"); in cfi_tell_features()
74 printk(" - Queued Erase: %s\n", extp->FeatureSupport&16?"supported":"unsupported"); in cfi_tell_features()
75 printk(" - Instant block lock: %s\n", extp->FeatureSupport&32?"supported":"unsupported"); in cfi_tell_features()
76 printk(" - Protection Bits: %s\n", extp->FeatureSupport&64?"supported":"unsupported"); in cfi_tell_features()
77 printk(" - Page-mode read: %s\n", extp->FeatureSupport&128?"supported":"unsupported"); in cfi_tell_features()
78 printk(" - Synchronous read: %s\n", extp->FeatureSupport&256?"supported":"unsupported"); in cfi_tell_features()
80 if (extp->FeatureSupport & (1<<i)) in cfi_tell_features()
81 printk(" - Unknown Bit %X: supported\n", i); in cfi_tell_features()
84 printk(" Supported functions after Suspend: %2.2X\n", extp->SuspendCmdSupport); in cfi_tell_features()
85 …printk(" - Program after Erase Suspend: %s\n", extp->SuspendCmdSupport&1?"supported":"unsuppor… in cfi_tell_features()
87 if (extp->SuspendCmdSupport & (1<<i)) in cfi_tell_features()
88 printk(" - Unknown Bit %X: supported\n", i); in cfi_tell_features()
91 printk(" Block Status Register Mask: %4.4X\n", extp->BlkStatusRegMask); in cfi_tell_features()
92 printk(" - Lock Bit Active: %s\n", extp->BlkStatusRegMask&1?"yes":"no"); in cfi_tell_features()
93 printk(" - Valid Bit Active: %s\n", extp->BlkStatusRegMask&2?"yes":"no"); in cfi_tell_features()
95 if (extp->BlkStatusRegMask & (1<<i)) in cfi_tell_features()
96 printk(" - Unknown Bit %X Active: yes\n",i); in cfi_tell_features()
100 extp->VccOptimal >> 8, extp->VccOptimal & 0xf); in cfi_tell_features()
101 if (extp->VppOptimal) in cfi_tell_features()
103 extp->VppOptimal >> 8, extp->VppOptimal & 0xf); in cfi_tell_features()
107 /* This routine is made available to other mtd code via
111 * this module is non-zero, i.e. between inter_module_get and
116 struct cfi_private *cfi = map->fldrv_priv; in cfi_cmdset_0020()
119 if (cfi->cfi_mode) { in cfi_cmdset_0020()
121 * It's a real CFI chip, not one for which the probe in cfi_cmdset_0020()
125 __u16 adr = primary?cfi->cfiq->P_ADR:cfi->cfiq->A_ADR; in cfi_cmdset_0020()
132 if (extp->MajorVersion != '1' || in cfi_cmdset_0020()
133 (extp->MinorVersion < '0' || extp->MinorVersion > '3')) { in cfi_cmdset_0020()
136 extp->MajorVersion, extp->MinorVersion); in cfi_cmdset_0020()
142 extp->FeatureSupport = cfi32_to_cpu(map, extp->FeatureSupport); in cfi_cmdset_0020()
143 extp->BlkStatusRegMask = cfi32_to_cpu(map, in cfi_cmdset_0020()
144 extp->BlkStatusRegMask); in cfi_cmdset_0020()
152 cfi->cmdset_priv = extp; in cfi_cmdset_0020()
155 for (i=0; i< cfi->numchips; i++) { in cfi_cmdset_0020()
156 cfi->chips[i].word_write_time = 128; in cfi_cmdset_0020()
157 cfi->chips[i].buffer_write_time = 128; in cfi_cmdset_0020()
158 cfi->chips[i].erase_time = 1024; in cfi_cmdset_0020()
159 cfi->chips[i].ref_point_counter = 0; in cfi_cmdset_0020()
160 init_waitqueue_head(&(cfi->chips[i].wq)); in cfi_cmdset_0020()
169 struct cfi_private *cfi = map->fldrv_priv; in cfi_staa_setup()
173 unsigned long devsize = (1<<cfi->cfiq->DevSize) * cfi->interleave; in cfi_staa_setup()
176 //printk(KERN_DEBUG "number of CFI chips: %d\n", cfi->numchips); in cfi_staa_setup()
179 kfree(cfi->cmdset_priv); in cfi_staa_setup()
183 mtd->priv = map; in cfi_staa_setup()
184 mtd->type = MTD_NORFLASH; in cfi_staa_setup()
185 mtd->size = devsize * cfi->numchips; in cfi_staa_setup()
187 mtd->numeraseregions = cfi->cfiq->NumEraseRegions * cfi->numchips; in cfi_staa_setup()
188 mtd->eraseregions = kmalloc_array(mtd->numeraseregions, in cfi_staa_setup()
191 if (!mtd->eraseregions) { in cfi_staa_setup()
192 kfree(cfi->cmdset_priv); in cfi_staa_setup()
197 for (i=0; i<cfi->cfiq->NumEraseRegions; i++) { in cfi_staa_setup()
199 ersize = ((cfi->cfiq->EraseRegionInfo[i] >> 8) & ~0xff) * cfi->interleave; in cfi_staa_setup()
200 ernum = (cfi->cfiq->EraseRegionInfo[i] & 0xffff) + 1; in cfi_staa_setup()
202 if (mtd->erasesize < ersize) { in cfi_staa_setup()
203 mtd->erasesize = ersize; in cfi_staa_setup()
205 for (j=0; j<cfi->numchips; j++) { in cfi_staa_setup()
206 mtd->eraseregions[(j*cfi->cfiq->NumEraseRegions)+i].offset = (j*devsize)+offset; in cfi_staa_setup()
207 mtd->eraseregions[(j*cfi->cfiq->NumEraseRegions)+i].erasesize = ersize; in cfi_staa_setup()
208 mtd->eraseregions[(j*cfi->cfiq->NumEraseRegions)+i].numblocks = ernum; in cfi_staa_setup()
216 kfree(mtd->eraseregions); in cfi_staa_setup()
217 kfree(cfi->cmdset_priv); in cfi_staa_setup()
222 for (i=0; i<mtd->numeraseregions;i++){ in cfi_staa_setup()
224 i, (unsigned long long)mtd->eraseregions[i].offset, in cfi_staa_setup()
225 mtd->eraseregions[i].erasesize, in cfi_staa_setup()
226 mtd->eraseregions[i].numblocks); in cfi_staa_setup()
230 mtd->_erase = cfi_staa_erase_varsize; in cfi_staa_setup()
231 mtd->_read = cfi_staa_read; in cfi_staa_setup()
232 mtd->_write = cfi_staa_write_buffers; in cfi_staa_setup()
233 mtd->_writev = cfi_staa_writev; in cfi_staa_setup()
234 mtd->_sync = cfi_staa_sync; in cfi_staa_setup()
235 mtd->_lock = cfi_staa_lock; in cfi_staa_setup()
236 mtd->_unlock = cfi_staa_unlock; in cfi_staa_setup()
237 mtd->_suspend = cfi_staa_suspend; in cfi_staa_setup()
238 mtd->_resume = cfi_staa_resume; in cfi_staa_setup()
239 mtd->flags = MTD_CAP_NORFLASH & ~MTD_BIT_WRITEABLE; in cfi_staa_setup()
240 mtd->writesize = 8; /* FIXME: Should be 0 for STMicro flashes w/out ECC */ in cfi_staa_setup()
241 mtd->writebufsize = cfi_interleave(cfi) << cfi->cfiq->MaxBufWriteSize; in cfi_staa_setup()
242 map->fldrv = &cfi_staa_chipdrv; in cfi_staa_setup()
244 mtd->name = map->name; in cfi_staa_setup()
249 static inline int do_read_onechip(struct map_info *map, struct flchip *chip, loff_t adr, size_t len… in do_read_onechip() argument
256 struct cfi_private *cfi = map->fldrv_priv; in do_read_onechip()
258 adr += chip->start; in do_read_onechip()
261 cmd_addr = adr & ~(map_bankwidth(map)-1); in do_read_onechip()
263 /* Let's determine this according to the interleave only once */ in do_read_onechip()
268 mutex_lock(&chip->mutex); in do_read_onechip()
270 /* Check that the chip's ready to talk to us. in do_read_onechip()
273 switch (chip->state) { in do_read_onechip()
275 if (!(((struct cfi_pri_intelext *)cfi->cmdset_priv)->FeatureSupport & 2)) in do_read_onechip()
280 * appears to make some (28F320) flash devices switch to in do_read_onechip()
281 * 'read' mode. Make sure that we switch to 'read status' in do_read_onechip()
282 * mode so we get the right data. --rmk in do_read_onechip()
285 chip->oldstate = FL_ERASING; in do_read_onechip()
286 chip->state = FL_ERASE_SUSPENDING; in do_read_onechip()
298 chip->state = FL_ERASING; in do_read_onechip()
299 wake_up(&chip->wq); in do_read_onechip()
300 mutex_unlock(&chip->mutex); in do_read_onechip()
301 printk(KERN_ERR "Chip not ready after erase " in do_read_onechip()
303 return -EIO; in do_read_onechip()
306 mutex_unlock(&chip->mutex); in do_read_onechip()
308 mutex_lock(&chip->mutex); in do_read_onechip()
313 chip->state = FL_READY; in do_read_onechip()
327 chip->state = FL_STATUS; in do_read_onechip()
333 chip->state = FL_READY; in do_read_onechip()
337 /* Urgh. Chip not yet ready to talk to us. */ in do_read_onechip()
339 mutex_unlock(&chip->mutex); in do_read_onechip()
340 …printk(KERN_ERR "waiting for chip to be ready timed out in read. WSM status = %lx\n", status.x[0]); in do_read_onechip()
341 return -EIO; in do_read_onechip()
345 mutex_unlock(&chip->mutex); in do_read_onechip()
351 /* Stick ourselves on a wait queue to be woken when in do_read_onechip()
354 add_wait_queue(&chip->wq, &wait); in do_read_onechip()
355 mutex_unlock(&chip->mutex); in do_read_onechip()
357 remove_wait_queue(&chip->wq, &wait); in do_read_onechip()
365 chip->state = chip->oldstate; in do_read_onechip()
366 /* What if one interleaved chip has finished and the in do_read_onechip()
368 one in READY mode. That's bad, and caused -EROFS in do_read_onechip()
369 errors to be returned from do_erase_oneblock because in do_read_onechip()
371 As the state machine appears to explicitly allow in do_read_onechip()
372 sending the 0x70 (Read Status) command to an erasing in do_read_onechip()
373 chip and expecting it to be ignored, that's what we in do_read_onechip()
379 wake_up(&chip->wq); in do_read_onechip()
380 mutex_unlock(&chip->mutex); in do_read_onechip()
386 struct map_info *map = mtd->priv; in cfi_staa_read()
387 struct cfi_private *cfi = map->fldrv_priv; in cfi_staa_read()
392 /* ofs: offset within the first chip that the first read should start */ in cfi_staa_read()
393 chipnum = (from >> cfi->chipshift); in cfi_staa_read()
394 ofs = from - (chipnum << cfi->chipshift); in cfi_staa_read()
399 if (chipnum >= cfi->numchips) in cfi_staa_read()
402 if ((len + ofs -1) >> cfi->chipshift) in cfi_staa_read()
403 thislen = (1<<cfi->chipshift) - ofs; in cfi_staa_read()
407 ret = do_read_onechip(map, &cfi->chips[chipnum], ofs, thislen, buf); in cfi_staa_read()
412 len -= thislen; in cfi_staa_read()
421 static int do_write_buffer(struct map_info *map, struct flchip *chip, in do_write_buffer() argument
424 struct cfi_private *cfi = map->fldrv_priv; in do_write_buffer()
430 /* M58LW064A requires bus alignment for buffer wriets -- saw */ in do_write_buffer()
431 if (adr & (map_bankwidth(map)-1)) in do_write_buffer()
432 return -EINVAL; in do_write_buffer()
434 wbufsize = cfi_interleave(cfi) << cfi->cfiq->MaxBufWriteSize; in do_write_buffer()
435 adr += chip->start; in do_write_buffer()
436 cmd_adr = adr & ~(wbufsize-1); in do_write_buffer()
438 /* Let's determine this according to the interleave only once */ in do_write_buffer()
445 printk("%s: chip->state[%d]\n", __func__, chip->state); in do_write_buffer()
447 mutex_lock(&chip->mutex); in do_write_buffer()
449 /* Check that the chip's ready to talk to us. in do_write_buffer()
454 switch (chip->state) { in do_write_buffer()
461 chip->state = FL_STATUS; in do_write_buffer()
470 /* Urgh. Chip not yet ready to talk to us. */ in do_write_buffer()
472 mutex_unlock(&chip->mutex); in do_write_buffer()
473 …printk(KERN_ERR "waiting for chip to be ready timed out in buffer write Xstatus = %lx, status = %l… in do_write_buffer()
475 return -EIO; in do_write_buffer()
479 mutex_unlock(&chip->mutex); in do_write_buffer()
484 /* Stick ourselves on a wait queue to be woken when in do_write_buffer()
487 add_wait_queue(&chip->wq, &wait); in do_write_buffer()
488 mutex_unlock(&chip->mutex); in do_write_buffer()
490 remove_wait_queue(&chip->wq, &wait); in do_write_buffer()
497 chip->state = FL_WRITING_TO_BUFFER; in do_write_buffer()
505 mutex_unlock(&chip->mutex); in do_write_buffer()
507 mutex_lock(&chip->mutex); in do_write_buffer()
510 /* Argh. Not ready for write to buffer */ in do_write_buffer()
513 chip->state = FL_STATUS; in do_write_buffer()
514 mutex_unlock(&chip->mutex); in do_write_buffer()
515 printk(KERN_ERR "Chip not ready for buffer write. Xstatus = %lx\n", status.x[0]); in do_write_buffer()
516 return -EIO; in do_write_buffer()
520 /* Write length of data to come */ in do_write_buffer()
521 map_write(map, CMD(len/map_bankwidth(map)-1), cmd_adr ); in do_write_buffer()
532 chip->state = FL_WRITING; in do_write_buffer()
534 mutex_unlock(&chip->mutex); in do_write_buffer()
535 cfi_udelay(chip->buffer_write_time); in do_write_buffer()
536 mutex_lock(&chip->mutex); in do_write_buffer()
541 if (chip->state != FL_WRITING) { in do_write_buffer()
544 add_wait_queue(&chip->wq, &wait); in do_write_buffer()
545 mutex_unlock(&chip->mutex); in do_write_buffer()
547 remove_wait_queue(&chip->wq, &wait); in do_write_buffer()
549 mutex_lock(&chip->mutex); in do_write_buffer()
563 chip->state = FL_STATUS; in do_write_buffer()
565 mutex_unlock(&chip->mutex); in do_write_buffer()
566 printk(KERN_ERR "waiting for chip to be ready timed out in bufwrite\n"); in do_write_buffer()
567 return -EIO; in do_write_buffer()
571 mutex_unlock(&chip->mutex); in do_write_buffer()
574 mutex_lock(&chip->mutex); in do_write_buffer()
577 chip->buffer_write_time--; in do_write_buffer()
578 if (!chip->buffer_write_time) in do_write_buffer()
579 chip->buffer_write_time++; in do_write_buffer()
582 chip->buffer_write_time++; in do_write_buffer()
586 chip->state = FL_STATUS; in do_write_buffer()
588 … /* check for errors: 'lock bit', 'VPP', 'dead cell'/'unerased cell' or 'incorrect cmd' -- saw */ in do_write_buffer()
597 wake_up(&chip->wq); in do_write_buffer()
598 mutex_unlock(&chip->mutex); in do_write_buffer()
599 return map_word_bitsset(map, status, CMD(0x02)) ? -EROFS : -EIO; in do_write_buffer()
601 wake_up(&chip->wq); in do_write_buffer()
602 mutex_unlock(&chip->mutex); in do_write_buffer()
607 static int cfi_staa_write_buffers (struct mtd_info *mtd, loff_t to, in cfi_staa_write_buffers() argument
610 struct map_info *map = mtd->priv; in cfi_staa_write_buffers()
611 struct cfi_private *cfi = map->fldrv_priv; in cfi_staa_write_buffers()
612 int wbufsize = cfi_interleave(cfi) << cfi->cfiq->MaxBufWriteSize; in cfi_staa_write_buffers()
617 chipnum = to >> cfi->chipshift; in cfi_staa_write_buffers()
618 ofs = to - (chipnum << cfi->chipshift); in cfi_staa_write_buffers()
626 /* Write buffer is worth it only if more than one word to write... */ in cfi_staa_write_buffers()
629 int size = wbufsize - (ofs & (wbufsize-1)); in cfi_staa_write_buffers()
634 ret = do_write_buffer(map, &cfi->chips[chipnum], in cfi_staa_write_buffers()
642 len -= size; in cfi_staa_write_buffers()
644 if (ofs >> cfi->chipshift) { in cfi_staa_write_buffers()
647 if (chipnum == cfi->numchips) in cfi_staa_write_buffers()
656 * Writev for ECC-Flashes is a little more complicated. We need to maintain
660 #define ECCBUF_SIZE (mtd->writesize)
661 #define ECCBUF_DIV(x) ((x) & ~(ECCBUF_SIZE - 1))
662 #define ECCBUF_MOD(x) ((x) & (ECCBUF_SIZE - 1))
665 unsigned long count, loff_t to, size_t *retlen) in cfi_staa_writev() argument
674 /* We should fall back to a general writev implementation. in cfi_staa_writev()
677 return -EIO; in cfi_staa_writev()
681 return -ENOMEM; in cfi_staa_writev()
694 memcpy(buffer+buflen, elem_base, ECCBUF_SIZE-buflen); in cfi_staa_writev()
695 ret = mtd_write(mtd, to, ECCBUF_SIZE, &thislen, in cfi_staa_writev()
700 elem_len -= thislen-buflen; in cfi_staa_writev()
701 elem_base += thislen-buflen; in cfi_staa_writev()
702 to += ECCBUF_SIZE; in cfi_staa_writev()
705 ret = mtd_write(mtd, to, ECCBUF_DIV(elem_len), in cfi_staa_writev()
710 to += thislen; in cfi_staa_writev()
720 ret = mtd_write(mtd, to, buflen, &thislen, buffer); in cfi_staa_writev()
733 static inline int do_erase_oneblock(struct map_info *map, struct flchip *chip, unsigned long adr) in do_erase_oneblock() argument
735 struct cfi_private *cfi = map->fldrv_priv; in do_erase_oneblock()
742 adr += chip->start; in do_erase_oneblock()
744 /* Let's determine this according to the interleave only once */ in do_erase_oneblock()
749 mutex_lock(&chip->mutex); in do_erase_oneblock()
751 /* Check that the chip's ready to talk to us. */ in do_erase_oneblock()
752 switch (chip->state) { in do_erase_oneblock()
757 chip->state = FL_STATUS; in do_erase_oneblock()
764 /* Urgh. Chip not yet ready to talk to us. */ in do_erase_oneblock()
766 mutex_unlock(&chip->mutex); in do_erase_oneblock()
767 printk(KERN_ERR "waiting for chip to be ready timed out in erase\n"); in do_erase_oneblock()
768 return -EIO; in do_erase_oneblock()
772 mutex_unlock(&chip->mutex); in do_erase_oneblock()
777 /* Stick ourselves on a wait queue to be woken when in do_erase_oneblock()
780 add_wait_queue(&chip->wq, &wait); in do_erase_oneblock()
781 mutex_unlock(&chip->mutex); in do_erase_oneblock()
783 remove_wait_queue(&chip->wq, &wait); in do_erase_oneblock()
795 chip->state = FL_ERASING; in do_erase_oneblock()
797 mutex_unlock(&chip->mutex); in do_erase_oneblock()
799 mutex_lock(&chip->mutex); in do_erase_oneblock()
801 /* FIXME. Use a timer to check this, and return immediately. */ in do_erase_oneblock()
802 /* Once the state machine's known to be working I'll do that */ in do_erase_oneblock()
806 if (chip->state != FL_ERASING) { in do_erase_oneblock()
809 add_wait_queue(&chip->wq, &wait); in do_erase_oneblock()
810 mutex_unlock(&chip->mutex); in do_erase_oneblock()
812 remove_wait_queue(&chip->wq, &wait); in do_erase_oneblock()
814 mutex_lock(&chip->mutex); in do_erase_oneblock()
825 chip->state = FL_STATUS; in do_erase_oneblock()
826 …printk(KERN_ERR "waiting for erase to complete timed out. Xstatus = %lx, status = %lx.\n", status.… in do_erase_oneblock()
828 mutex_unlock(&chip->mutex); in do_erase_oneblock()
829 return -EIO; in do_erase_oneblock()
833 mutex_unlock(&chip->mutex); in do_erase_oneblock()
835 mutex_lock(&chip->mutex); in do_erase_oneblock()
841 /* We've broken this before. It doesn't hurt to be safe */ in do_erase_oneblock()
843 chip->state = FL_STATUS; in do_erase_oneblock()
853 chipstatus |= status.x[w] >> (cfi->device_type * 8); in do_erase_oneblock()
856 printk(KERN_WARNING "Status is not identical for all chips: 0x%lx. Merging to give 0x%02x\n", in do_erase_oneblock()
864 printk(KERN_NOTICE "Chip reports improper command sequence: status 0x%x\n", chipstatus); in do_erase_oneblock()
865 ret = -EIO; in do_erase_oneblock()
868 ret = -EROFS; in do_erase_oneblock()
871 printk(KERN_WARNING "Chip reports voltage low on erase: status 0x%x\n", chipstatus); in do_erase_oneblock()
872 ret = -EIO; in do_erase_oneblock()
874 if (retries--) { in do_erase_oneblock()
875 printk(KERN_DEBUG "Chip erase failed at 0x%08lx: status 0x%x. Retrying...\n", adr, chipstatus); in do_erase_oneblock()
877 chip->state = FL_STATUS; in do_erase_oneblock()
878 mutex_unlock(&chip->mutex); in do_erase_oneblock()
881 printk(KERN_DEBUG "Chip erase failed at 0x%08lx: status 0x%x\n", adr, chipstatus); in do_erase_oneblock()
882 ret = -EIO; in do_erase_oneblock()
886 wake_up(&chip->wq); in do_erase_oneblock()
887 mutex_unlock(&chip->mutex); in do_erase_oneblock()
893 { struct map_info *map = mtd->priv; in cfi_staa_erase_varsize()
894 struct cfi_private *cfi = map->fldrv_priv; in cfi_staa_erase_varsize()
898 struct mtd_erase_region_info *regions = mtd->eraseregions; in cfi_staa_erase_varsize()
907 the requested erase. Actually, to save on the calculations, in cfi_staa_erase_varsize()
908 we skip to the first erase region which starts after the in cfi_staa_erase_varsize()
912 while (i < mtd->numeraseregions && instr->addr >= regions[i].offset) in cfi_staa_erase_varsize()
914 i--; in cfi_staa_erase_varsize()
922 if (instr->addr & (regions[i].erasesize-1)) in cfi_staa_erase_varsize()
923 return -EINVAL; in cfi_staa_erase_varsize()
932 while (i<mtd->numeraseregions && (instr->addr + instr->len) >= regions[i].offset) in cfi_staa_erase_varsize()
935 /* As before, drop back one to point at the region in which in cfi_staa_erase_varsize()
938 i--; in cfi_staa_erase_varsize()
940 if ((instr->addr + instr->len) & (regions[i].erasesize-1)) in cfi_staa_erase_varsize()
941 return -EINVAL; in cfi_staa_erase_varsize()
943 chipnum = instr->addr >> cfi->chipshift; in cfi_staa_erase_varsize()
944 adr = instr->addr - (chipnum << cfi->chipshift); in cfi_staa_erase_varsize()
945 len = instr->len; in cfi_staa_erase_varsize()
950 ret = do_erase_oneblock(map, &cfi->chips[chipnum], adr); in cfi_staa_erase_varsize()
956 len -= regions[i].erasesize; in cfi_staa_erase_varsize()
958 …if (adr % (1<< cfi->chipshift) == (((unsigned long)regions[i].offset + (regions[i].erasesize * reg… in cfi_staa_erase_varsize()
961 if (adr >> cfi->chipshift) { in cfi_staa_erase_varsize()
965 if (chipnum >= cfi->numchips) in cfi_staa_erase_varsize()
975 struct map_info *map = mtd->priv; in cfi_staa_sync()
976 struct cfi_private *cfi = map->fldrv_priv; in cfi_staa_sync()
978 struct flchip *chip; in cfi_staa_sync() local
982 for (i=0; !ret && i<cfi->numchips; i++) { in cfi_staa_sync()
983 chip = &cfi->chips[i]; in cfi_staa_sync()
986 mutex_lock(&chip->mutex); in cfi_staa_sync()
988 switch(chip->state) { in cfi_staa_sync()
993 chip->oldstate = chip->state; in cfi_staa_sync()
994 chip->state = FL_SYNCING; in cfi_staa_sync()
995 /* No need to wake_up() on this state change - in cfi_staa_sync()
997 * with the chip now anyway. in cfi_staa_sync()
1001 mutex_unlock(&chip->mutex); in cfi_staa_sync()
1007 add_wait_queue(&chip->wq, &wait); in cfi_staa_sync()
1009 mutex_unlock(&chip->mutex); in cfi_staa_sync()
1011 remove_wait_queue(&chip->wq, &wait); in cfi_staa_sync()
1019 for (i--; i >=0; i--) { in cfi_staa_sync()
1020 chip = &cfi->chips[i]; in cfi_staa_sync()
1022 mutex_lock(&chip->mutex); in cfi_staa_sync()
1024 if (chip->state == FL_SYNCING) { in cfi_staa_sync()
1025 chip->state = chip->oldstate; in cfi_staa_sync()
1026 wake_up(&chip->wq); in cfi_staa_sync()
1028 mutex_unlock(&chip->mutex); in cfi_staa_sync()
1032 static inline int do_lock_oneblock(struct map_info *map, struct flchip *chip, unsigned long adr) in do_lock_oneblock() argument
1034 struct cfi_private *cfi = map->fldrv_priv; in do_lock_oneblock()
1039 adr += chip->start; in do_lock_oneblock()
1041 /* Let's determine this according to the interleave only once */ in do_lock_oneblock()
1046 mutex_lock(&chip->mutex); in do_lock_oneblock()
1048 /* Check that the chip's ready to talk to us. */ in do_lock_oneblock()
1049 switch (chip->state) { in do_lock_oneblock()
1054 chip->state = FL_STATUS; in do_lock_oneblock()
1061 /* Urgh. Chip not yet ready to talk to us. */ in do_lock_oneblock()
1063 mutex_unlock(&chip->mutex); in do_lock_oneblock()
1064 printk(KERN_ERR "waiting for chip to be ready timed out in lock\n"); in do_lock_oneblock()
1065 return -EIO; in do_lock_oneblock()
1069 mutex_unlock(&chip->mutex); in do_lock_oneblock()
1074 /* Stick ourselves on a wait queue to be woken when in do_lock_oneblock()
1077 add_wait_queue(&chip->wq, &wait); in do_lock_oneblock()
1078 mutex_unlock(&chip->mutex); in do_lock_oneblock()
1080 remove_wait_queue(&chip->wq, &wait); in do_lock_oneblock()
1088 chip->state = FL_LOCKING; in do_lock_oneblock()
1090 mutex_unlock(&chip->mutex); in do_lock_oneblock()
1092 mutex_lock(&chip->mutex); in do_lock_oneblock()
1094 /* FIXME. Use a timer to check this, and return immediately. */ in do_lock_oneblock()
1095 /* Once the state machine's known to be working I'll do that */ in do_lock_oneblock()
1107 chip->state = FL_STATUS; in do_lock_oneblock()
1108 …printk(KERN_ERR "waiting for lock to complete timed out. Xstatus = %lx, status = %lx.\n", status.x… in do_lock_oneblock()
1110 mutex_unlock(&chip->mutex); in do_lock_oneblock()
1111 return -EIO; in do_lock_oneblock()
1115 mutex_unlock(&chip->mutex); in do_lock_oneblock()
1117 mutex_lock(&chip->mutex); in do_lock_oneblock()
1121 chip->state = FL_STATUS; in do_lock_oneblock()
1123 wake_up(&chip->wq); in do_lock_oneblock()
1124 mutex_unlock(&chip->mutex); in do_lock_oneblock()
1129 struct map_info *map = mtd->priv; in cfi_staa_lock()
1130 struct cfi_private *cfi = map->fldrv_priv; in cfi_staa_lock()
1134 int ofs_factor = cfi->interleave * cfi->device_type; in cfi_staa_lock()
1137 if (ofs & (mtd->erasesize - 1)) in cfi_staa_lock()
1138 return -EINVAL; in cfi_staa_lock()
1140 if (len & (mtd->erasesize -1)) in cfi_staa_lock()
1141 return -EINVAL; in cfi_staa_lock()
1143 chipnum = ofs >> cfi->chipshift; in cfi_staa_lock()
1144 adr = ofs - (chipnum << cfi->chipshift); in cfi_staa_lock()
1149 cfi_send_gen_cmd(0x90, 0x55, 0, map, cfi, cfi->device_type, NULL); in cfi_staa_lock()
1151 cfi_send_gen_cmd(0xff, 0x55, 0, map, cfi, cfi->device_type, NULL); in cfi_staa_lock()
1154 ret = do_lock_oneblock(map, &cfi->chips[chipnum], adr); in cfi_staa_lock()
1157 cfi_send_gen_cmd(0x90, 0x55, 0, map, cfi, cfi->device_type, NULL); in cfi_staa_lock()
1159 cfi_send_gen_cmd(0xff, 0x55, 0, map, cfi, cfi->device_type, NULL); in cfi_staa_lock()
1165 adr += mtd->erasesize; in cfi_staa_lock()
1166 len -= mtd->erasesize; in cfi_staa_lock()
1168 if (adr >> cfi->chipshift) { in cfi_staa_lock()
1172 if (chipnum >= cfi->numchips) in cfi_staa_lock()
1178 static inline int do_unlock_oneblock(struct map_info *map, struct flchip *chip, unsigned long adr) in do_unlock_oneblock() argument
1180 struct cfi_private *cfi = map->fldrv_priv; in do_unlock_oneblock()
1185 adr += chip->start; in do_unlock_oneblock()
1187 /* Let's determine this according to the interleave only once */ in do_unlock_oneblock()
1192 mutex_lock(&chip->mutex); in do_unlock_oneblock()
1194 /* Check that the chip's ready to talk to us. */ in do_unlock_oneblock()
1195 switch (chip->state) { in do_unlock_oneblock()
1200 chip->state = FL_STATUS; in do_unlock_oneblock()
1207 /* Urgh. Chip not yet ready to talk to us. */ in do_unlock_oneblock()
1209 mutex_unlock(&chip->mutex); in do_unlock_oneblock()
1210 printk(KERN_ERR "waiting for chip to be ready timed out in unlock\n"); in do_unlock_oneblock()
1211 return -EIO; in do_unlock_oneblock()
1215 mutex_unlock(&chip->mutex); in do_unlock_oneblock()
1220 /* Stick ourselves on a wait queue to be woken when in do_unlock_oneblock()
1223 add_wait_queue(&chip->wq, &wait); in do_unlock_oneblock()
1224 mutex_unlock(&chip->mutex); in do_unlock_oneblock()
1226 remove_wait_queue(&chip->wq, &wait); in do_unlock_oneblock()
1234 chip->state = FL_UNLOCKING; in do_unlock_oneblock()
1236 mutex_unlock(&chip->mutex); in do_unlock_oneblock()
1238 mutex_lock(&chip->mutex); in do_unlock_oneblock()
1240 /* FIXME. Use a timer to check this, and return immediately. */ in do_unlock_oneblock()
1241 /* Once the state machine's known to be working I'll do that */ in do_unlock_oneblock()
1253 chip->state = FL_STATUS; in do_unlock_oneblock()
1254 …printk(KERN_ERR "waiting for unlock to complete timed out. Xstatus = %lx, status = %lx.\n", status… in do_unlock_oneblock()
1256 mutex_unlock(&chip->mutex); in do_unlock_oneblock()
1257 return -EIO; in do_unlock_oneblock()
1261 mutex_unlock(&chip->mutex); in do_unlock_oneblock()
1263 mutex_lock(&chip->mutex); in do_unlock_oneblock()
1267 chip->state = FL_STATUS; in do_unlock_oneblock()
1269 wake_up(&chip->wq); in do_unlock_oneblock()
1270 mutex_unlock(&chip->mutex); in do_unlock_oneblock()
1275 struct map_info *map = mtd->priv; in cfi_staa_unlock()
1276 struct cfi_private *cfi = map->fldrv_priv; in cfi_staa_unlock()
1280 int ofs_factor = cfi->interleave * cfi->device_type; in cfi_staa_unlock()
1283 chipnum = ofs >> cfi->chipshift; in cfi_staa_unlock()
1284 adr = ofs - (chipnum << cfi->chipshift); in cfi_staa_unlock()
1291 cfi_send_gen_cmd(0x90, 0x55, 0, map, cfi, cfi->device_type, NULL); in cfi_staa_unlock()
1294 temp_adr += mtd->erasesize; in cfi_staa_unlock()
1295 temp_len -= mtd->erasesize; in cfi_staa_unlock()
1297 cfi_send_gen_cmd(0xff, 0x55, 0, map, cfi, cfi->device_type, NULL); in cfi_staa_unlock()
1301 ret = do_unlock_oneblock(map, &cfi->chips[chipnum], adr); in cfi_staa_unlock()
1304 cfi_send_gen_cmd(0x90, 0x55, 0, map, cfi, cfi->device_type, NULL); in cfi_staa_unlock()
1306 cfi_send_gen_cmd(0xff, 0x55, 0, map, cfi, cfi->device_type, NULL); in cfi_staa_unlock()
1314 struct map_info *map = mtd->priv; in cfi_staa_suspend()
1315 struct cfi_private *cfi = map->fldrv_priv; in cfi_staa_suspend()
1317 struct flchip *chip; in cfi_staa_suspend() local
1320 for (i=0; !ret && i<cfi->numchips; i++) { in cfi_staa_suspend()
1321 chip = &cfi->chips[i]; in cfi_staa_suspend()
1323 mutex_lock(&chip->mutex); in cfi_staa_suspend()
1325 switch(chip->state) { in cfi_staa_suspend()
1330 chip->oldstate = chip->state; in cfi_staa_suspend()
1331 chip->state = FL_PM_SUSPENDED; in cfi_staa_suspend()
1332 /* No need to wake_up() on this state change - in cfi_staa_suspend()
1334 * with the chip now anyway. in cfi_staa_suspend()
1342 ret = -EAGAIN; in cfi_staa_suspend()
1345 mutex_unlock(&chip->mutex); in cfi_staa_suspend()
1351 for (i--; i >=0; i--) { in cfi_staa_suspend()
1352 chip = &cfi->chips[i]; in cfi_staa_suspend()
1354 mutex_lock(&chip->mutex); in cfi_staa_suspend()
1356 if (chip->state == FL_PM_SUSPENDED) { in cfi_staa_suspend()
1357 /* No need to force it into a known state here, in cfi_staa_suspend()
1360 chip->state = chip->oldstate; in cfi_staa_suspend()
1361 wake_up(&chip->wq); in cfi_staa_suspend()
1363 mutex_unlock(&chip->mutex); in cfi_staa_suspend()
1372 struct map_info *map = mtd->priv; in cfi_staa_resume()
1373 struct cfi_private *cfi = map->fldrv_priv; in cfi_staa_resume()
1375 struct flchip *chip; in cfi_staa_resume() local
1377 for (i=0; i<cfi->numchips; i++) { in cfi_staa_resume()
1379 chip = &cfi->chips[i]; in cfi_staa_resume()
1381 mutex_lock(&chip->mutex); in cfi_staa_resume()
1383 /* Go to known state. Chip may have been power cycled */ in cfi_staa_resume()
1384 if (chip->state == FL_PM_SUSPENDED) { in cfi_staa_resume()
1386 chip->state = FL_READY; in cfi_staa_resume()
1387 wake_up(&chip->wq); in cfi_staa_resume()
1390 mutex_unlock(&chip->mutex); in cfi_staa_resume()
1396 struct map_info *map = mtd->priv; in cfi_staa_destroy()
1397 struct cfi_private *cfi = map->fldrv_priv; in cfi_staa_destroy()
1398 kfree(cfi->cmdset_priv); in cfi_staa_destroy()
1402 MODULE_DESCRIPTION("MTD chip driver for ST Advanced Architecture Command Set (ID 0x0020)");