Lines Matching +full:use +full:- +full:minimum +full:- +full:ecc
1 // SPDX-License-Identifier: GPL-2.0-only
3 * Copyright © 2009 - Maxim Levitsky
31 MODULE_PARM_DESC(debug, "Debug level (0-2)");
34 /* ------------------- sysfs attributes ---------------------------------- */
47 strncpy(buf, sm_attr->data, sm_attr->len); in sm_attr_show()
48 return sm_attr->len; in sm_attr_show()
61 vendor = kstrndup(ftl->cis_buffer + SM_CIS_VENDOR_OFFSET, in sm_create_sysfs_attributes()
62 SM_SMALL_PAGE - SM_CIS_VENDOR_OFFSET, GFP_KERNEL); in sm_create_sysfs_attributes()
72 sysfs_attr_init(&vendor_attribute->dev_attr.attr); in sm_create_sysfs_attributes()
74 vendor_attribute->data = vendor; in sm_create_sysfs_attributes()
75 vendor_attribute->len = strlen(vendor); in sm_create_sysfs_attributes()
76 vendor_attribute->dev_attr.attr.name = "vendor"; in sm_create_sysfs_attributes()
77 vendor_attribute->dev_attr.attr.mode = S_IRUGO; in sm_create_sysfs_attributes()
78 vendor_attribute->dev_attr.show = sm_attr_show; in sm_create_sysfs_attributes()
86 attributes[0] = &vendor_attribute->dev_attr.attr; in sm_create_sysfs_attributes()
92 attr_group->attrs = attributes; in sm_create_sysfs_attributes()
106 struct attribute **attributes = ftl->disk_attributes->attrs; in sm_delete_sysfs_attributes()
118 kfree(sm_attr->data); in sm_delete_sysfs_attributes()
122 kfree(ftl->disk_attributes->attrs); in sm_delete_sysfs_attributes()
123 kfree(ftl->disk_attributes); in sm_delete_sysfs_attributes()
127 /* ----------------------- oob helpers -------------------------------------- */
133 return -2; in sm_get_lba()
135 /* check parity - endianness doesn't matter */ in sm_get_lba()
137 return -2; in sm_get_lba()
145 * returns -1, if block is erased
146 * returns -2 if error happens
158 return -1; in sm_read_lba()
161 lba_test = *(uint16_t *)oob->lba_copy1 ^ *(uint16_t*)oob->lba_copy2; in sm_read_lba()
163 return -2; in sm_read_lba()
166 lba = sm_get_lba(oob->lba_copy1); in sm_read_lba()
168 if (lba == -2) in sm_read_lba()
169 lba = sm_get_lba(oob->lba_copy2); in sm_read_lba()
186 oob->lba_copy1[0] = oob->lba_copy2[0] = tmp[0]; in sm_write_lba()
187 oob->lba_copy1[1] = oob->lba_copy2[1] = tmp[1]; in sm_write_lba()
194 WARN_ON(boffset & (SM_SECTOR_SIZE - 1)); in sm_mkoffset()
195 WARN_ON(zone < 0 || zone >= ftl->zone_count); in sm_mkoffset()
196 WARN_ON(block >= ftl->zone_size); in sm_mkoffset()
197 WARN_ON(boffset >= ftl->block_size); in sm_mkoffset()
199 if (block == -1) in sm_mkoffset()
200 return -1; in sm_mkoffset()
202 return (zone * SM_MAX_ZONE_SIZE + block) * ftl->block_size + boffset; in sm_mkoffset()
210 *boffset = do_div(offset, ftl->block_size); in sm_break_offset()
211 *block = do_div(offset, ftl->max_lba); in sm_break_offset()
212 *zone = offset >= ftl->zone_count ? -1 : offset; in sm_break_offset()
215 /* ---------------------- low level IO ------------------------------------- */
219 uint8_t ecc[3]; in sm_correct_sector() local
221 __nand_calculate_ecc(buffer, SM_SMALL_PAGE, ecc, in sm_correct_sector()
223 if (__nand_correct_data(buffer, ecc, oob->ecc1, SM_SMALL_PAGE, in sm_correct_sector()
225 return -EIO; in sm_correct_sector()
229 __nand_calculate_ecc(buffer, SM_SMALL_PAGE, ecc, in sm_correct_sector()
231 if (__nand_correct_data(buffer, ecc, oob->ecc2, SM_SMALL_PAGE, in sm_correct_sector()
233 return -EIO; in sm_correct_sector()
242 struct mtd_info *mtd = ftl->trans->mtd; in sm_read_sector()
245 int ret = -EIO; in sm_read_sector()
248 /* FTL can contain -1 entries that are by default filled with bits */ in sm_read_sector()
249 if (block == -1) { in sm_read_sector()
259 ops.mode = ftl->smallpagenand ? MTD_OPS_RAW : MTD_OPS_PLACE_OOB; in sm_read_sector()
270 if (zone == 0 && block == ftl->cis_block && boffset == in sm_read_sector()
271 ftl->cis_boffset) in sm_read_sector()
291 if (oob->reserved != 0xFFFFFFFF && !is_power_of_2(~oob->reserved)) in sm_read_sector()
308 /* Test ECC*/ in sm_read_sector()
310 (ftl->smallpagenand && sm_correct_sector(buffer, oob))) { in sm_read_sector()
312 dbg("read of block %d at zone %d, failed due to ECC error", in sm_read_sector()
326 struct mtd_info *mtd = ftl->trans->mtd; in sm_write_sector()
329 BUG_ON(ftl->readonly); in sm_write_sector()
331 if (zone == 0 && (block == ftl->cis_block || block == 0)) { in sm_write_sector()
333 return -EIO; in sm_write_sector()
336 if (ftl->unstable) in sm_write_sector()
337 return -EIO; in sm_write_sector()
339 ops.mode = ftl->smallpagenand ? MTD_OPS_RAW : MTD_OPS_PLACE_OOB; in sm_write_sector()
365 /* ------------------------ block IO ------------------------------------- */
380 if (ftl->unstable) in sm_write_block()
381 return -EIO; in sm_write_block()
383 for (boffset = 0; boffset < ftl->block_size; in sm_write_block()
397 if (ftl->smallpagenand) { in sm_write_block()
419 return -EIO; in sm_write_block()
425 return -EIO; in sm_write_block()
441 if (ftl->unstable) in sm_mark_block_bad()
452 for (boffset = 0; boffset < ftl->block_size; boffset += SM_SECTOR_SIZE) in sm_mark_block_bad()
463 struct ftl_zone *zone = &ftl->zones[zone_num]; in sm_erase_block()
464 struct mtd_info *mtd = ftl->trans->mtd; in sm_erase_block()
468 erase.len = ftl->block_size; in sm_erase_block()
470 if (ftl->unstable) in sm_erase_block()
471 return -EIO; in sm_erase_block()
473 BUG_ON(ftl->readonly); in sm_erase_block()
475 if (zone_num == 0 && (block == ftl->cis_block || block == 0)) { in sm_erase_block()
477 return -EIO; in sm_erase_block()
487 kfifo_in(&zone->free_sectors, in sm_erase_block()
493 return -EIO; in sm_erase_block()
501 int lbas[] = { -3, 0, 0, 0 }; in sm_check_block()
509 for (boffset = 0; boffset < ftl->block_size; in sm_check_block()
514 return -2; in sm_check_block()
523 return -EIO; in sm_check_block()
535 /* ----------------- media scanning --------------------------------- */
561 int size_in_megs = mtd->size / (1024 * 1024); in sm_get_media_info()
563 ftl->readonly = mtd->type == MTD_ROM; in sm_get_media_info()
566 ftl->zone_count = 1; in sm_get_media_info()
567 ftl->smallpagenand = 0; in sm_get_media_info()
572 ftl->zone_size = 256; in sm_get_media_info()
573 ftl->max_lba = 250; in sm_get_media_info()
574 ftl->block_size = 8 * SM_SECTOR_SIZE; in sm_get_media_info()
575 ftl->smallpagenand = 1; in sm_get_media_info()
580 if (mtd->writesize == SM_SMALL_PAGE) { in sm_get_media_info()
581 ftl->zone_size = 512; in sm_get_media_info()
582 ftl->max_lba = 500; in sm_get_media_info()
583 ftl->block_size = 8 * SM_SECTOR_SIZE; in sm_get_media_info()
584 ftl->smallpagenand = 1; in sm_get_media_info()
588 if (!ftl->readonly) in sm_get_media_info()
589 return -ENODEV; in sm_get_media_info()
591 ftl->zone_size = 256; in sm_get_media_info()
592 ftl->max_lba = 250; in sm_get_media_info()
593 ftl->block_size = 16 * SM_SECTOR_SIZE; in sm_get_media_info()
598 ftl->zone_size = 512; in sm_get_media_info()
599 ftl->max_lba = 500; in sm_get_media_info()
600 ftl->block_size = 16 * SM_SECTOR_SIZE; in sm_get_media_info()
604 ftl->zone_size = 1024; in sm_get_media_info()
605 ftl->max_lba = 1000; in sm_get_media_info()
606 ftl->block_size = 16 * SM_SECTOR_SIZE; in sm_get_media_info()
609 /* Minimum xD size is 16MiB. Also, all xD cards have standard zone in sm_get_media_info()
612 ftl->zone_count = size_in_megs / 16; in sm_get_media_info()
613 ftl->zone_size = 1024; in sm_get_media_info()
614 ftl->max_lba = 1000; in sm_get_media_info()
615 ftl->block_size = 32 * SM_SECTOR_SIZE; in sm_get_media_info()
619 if (mtd->erasesize > ftl->block_size) in sm_get_media_info()
620 return -ENODEV; in sm_get_media_info()
622 if (mtd->writesize > SM_SECTOR_SIZE) in sm_get_media_info()
623 return -ENODEV; in sm_get_media_info()
625 if (ftl->smallpagenand && mtd->oobsize < SM_SMALL_OOB_SIZE) in sm_get_media_info()
626 return -ENODEV; in sm_get_media_info()
628 if (!ftl->smallpagenand && mtd->oobsize < SM_OOB_SIZE) in sm_get_media_info()
629 return -ENODEV; in sm_get_media_info()
631 /* We use OOB */ in sm_get_media_info()
633 return -ENODEV; in sm_get_media_info()
638 ftl->cylinders = chs_table[i].cyl; in sm_get_media_info()
639 ftl->heads = chs_table[i].head; in sm_get_media_info()
640 ftl->sectors = chs_table[i].sec; in sm_get_media_info()
646 ftl->cylinders = 985; in sm_get_media_info()
647 ftl->heads = 33; in sm_get_media_info()
648 ftl->sectors = 63; in sm_get_media_info()
658 0, ftl->cis_block, ftl->cis_boffset, ftl->cis_buffer, &oob)) in sm_read_cis()
659 return -EIO; in sm_read_cis()
662 return -EIO; in sm_read_cis()
664 if (!memcmp(ftl->cis_buffer + ftl->cis_page_offset, in sm_read_cis()
669 return -EIO; in sm_read_cis()
681 for (block = 0 ; block < ftl->zone_size - ftl->max_lba ; block++) { in sm_find_cis()
693 return -EIO; in sm_find_cis()
696 for (boffset = 0 ; boffset < ftl->block_size; in sm_find_cis()
707 if (boffset == ftl->block_size) in sm_find_cis()
708 return -EIO; in sm_find_cis()
710 ftl->cis_block = block; in sm_find_cis()
711 ftl->cis_boffset = boffset; in sm_find_cis()
712 ftl->cis_page_offset = 0; in sm_find_cis()
717 ftl->cis_page_offset = SM_SMALL_PAGE; in sm_find_cis()
723 block * ftl->block_size + in sm_find_cis()
724 boffset + ftl->cis_page_offset); in sm_find_cis()
727 return -EIO; in sm_find_cis()
735 if (!ftl->unstable) { in sm_recheck_media()
737 ftl->unstable = 1; in sm_recheck_media()
739 return -EIO; in sm_recheck_media()
747 struct ftl_zone *zone = &ftl->zones[zone_num]; in sm_init_zone()
757 zone->lba_to_phys_table = kmalloc_array(ftl->max_lba, 2, GFP_KERNEL); in sm_init_zone()
759 if (!zone->lba_to_phys_table) in sm_init_zone()
760 return -ENOMEM; in sm_init_zone()
761 memset(zone->lba_to_phys_table, -1, ftl->max_lba * 2); in sm_init_zone()
765 if (kfifo_alloc(&zone->free_sectors, ftl->zone_size * 2, GFP_KERNEL)) { in sm_init_zone()
766 kfree(zone->lba_to_phys_table); in sm_init_zone()
767 return -ENOMEM; in sm_init_zone()
771 for (block = 0 ; block < ftl->zone_size ; block++) { in sm_init_zone()
774 if (zone_num == 0 && block <= ftl->cis_block) in sm_init_zone()
779 kfifo_free(&zone->free_sectors); in sm_init_zone()
780 kfree(zone->lba_to_phys_table); in sm_init_zone()
781 return -EIO; in sm_init_zone()
787 kfifo_in(&zone->free_sectors, in sm_init_zone()
797 dbg("PH %04d <-> <marked bad>", block); in sm_init_zone()
807 if (lba == -2 || lba >= ftl->max_lba) { in sm_init_zone()
808 dbg("PH %04d <-> LBA %04d(bad)", block, lba); in sm_init_zone()
815 if (zone->lba_to_phys_table[lba] < 0) { in sm_init_zone()
816 dbg_verbose("PH %04d <-> LBA %04d", block, lba); in sm_init_zone()
817 zone->lba_to_phys_table[lba] = block; in sm_init_zone()
823 lba, zone->lba_to_phys_table[lba], block, zone_num); in sm_init_zone()
831 zone->lba_to_phys_table[lba])) { in sm_init_zone()
832 zone->lba_to_phys_table[lba] = block; in sm_init_zone()
845 zone->initialized = 1; in sm_init_zone()
849 if (!kfifo_len(&zone->free_sectors)) { in sm_init_zone()
856 i %= (kfifo_len(&zone->free_sectors) / 2); in sm_init_zone()
858 while (i--) { in sm_init_zone()
859 len = kfifo_out(&zone->free_sectors, in sm_init_zone()
862 kfifo_in(&zone->free_sectors, (const unsigned char *)&block, 2); in sm_init_zone()
873 BUG_ON(zone_num >= ftl->zone_count); in sm_get_zone()
874 zone = &ftl->zones[zone_num]; in sm_get_zone()
876 if (!zone->initialized) { in sm_get_zone()
886 /* ----------------- cache handling ------------------------------------------*/
891 ftl->cache_data_invalid_bitmap = 0xFFFFFFFF; in sm_cache_init()
892 ftl->cache_clean = 1; in sm_cache_init()
893 ftl->cache_zone = -1; in sm_cache_init()
894 ftl->cache_block = -1; in sm_cache_init()
895 /*memset(ftl->cache_data, 0xAA, ftl->block_size);*/ in sm_cache_init()
901 memcpy(ftl->cache_data + boffset, buffer, SM_SECTOR_SIZE); in sm_cache_put()
902 clear_bit(boffset / SM_SECTOR_SIZE, &ftl->cache_data_invalid_bitmap); in sm_cache_put()
903 ftl->cache_clean = 0; in sm_cache_put()
910 &ftl->cache_data_invalid_bitmap)) in sm_cache_get()
911 return -1; in sm_cache_get()
913 memcpy(buffer, ftl->cache_data + boffset, SM_SECTOR_SIZE); in sm_cache_get()
924 int zone_num = ftl->cache_zone; in sm_cache_flush()
927 if (ftl->cache_clean) in sm_cache_flush()
930 if (ftl->unstable) in sm_cache_flush()
931 return -EIO; in sm_cache_flush()
934 zone = &ftl->zones[zone_num]; in sm_cache_flush()
935 block_num = zone->lba_to_phys_table[ftl->cache_block]; in sm_cache_flush()
939 for_each_set_bit(sector_num, &ftl->cache_data_invalid_bitmap, in sm_cache_flush()
940 ftl->block_size / SM_SECTOR_SIZE) { in sm_cache_flush()
944 ftl->cache_data + sector_num * SM_SECTOR_SIZE, NULL)) in sm_cache_flush()
946 &ftl->cache_data_invalid_bitmap); in sm_cache_flush()
950 if (ftl->unstable) in sm_cache_flush()
951 return -EIO; in sm_cache_flush()
957 if (kfifo_out(&zone->free_sectors, in sm_cache_flush()
960 return -EIO; in sm_cache_flush()
964 if (sm_write_block(ftl, ftl->cache_data, zone_num, write_sector, in sm_cache_flush()
965 ftl->cache_block, ftl->cache_data_invalid_bitmap)) in sm_cache_flush()
969 zone->lba_to_phys_table[ftl->cache_block] = write_sector; in sm_cache_flush()
984 queue_work(cache_flush_workqueue, &ftl->flush_work); in sm_cache_flush_timer()
991 mutex_lock(&ftl->mutex); in sm_cache_flush_work()
993 mutex_unlock(&ftl->mutex); in sm_cache_flush_work()
997 /* ---------------- outside interface -------------------------------------- */
1003 struct sm_ftl *ftl = dev->priv; in sm_read()
1009 mutex_lock(&ftl->mutex); in sm_read()
1019 if (ftl->cache_zone == zone_num && ftl->cache_block == block) { in sm_read()
1026 block = zone->lba_to_phys_table[block]; in sm_read()
1028 if (block == -1) { in sm_read()
1034 error = -EIO; in sm_read()
1041 mutex_unlock(&ftl->mutex); in sm_read()
1049 struct sm_ftl *ftl = dev->priv; in sm_write()
1053 BUG_ON(ftl->readonly); in sm_write()
1057 del_timer(&ftl->timer); in sm_write()
1058 mutex_lock(&ftl->mutex); in sm_write()
1067 if (ftl->cache_block != block || ftl->cache_zone != zone_num) { in sm_write()
1073 ftl->cache_block = block; in sm_write()
1074 ftl->cache_zone = zone_num; in sm_write()
1079 mod_timer(&ftl->timer, jiffies + msecs_to_jiffies(cache_timeout)); in sm_write()
1080 mutex_unlock(&ftl->mutex); in sm_write()
1087 struct sm_ftl *ftl = dev->priv; in sm_flush()
1090 mutex_lock(&ftl->mutex); in sm_flush()
1092 mutex_unlock(&ftl->mutex); in sm_flush()
1099 struct sm_ftl *ftl = dev->priv; in sm_release()
1101 mutex_lock(&ftl->mutex); in sm_release()
1102 del_timer_sync(&ftl->timer); in sm_release()
1103 cancel_work_sync(&ftl->flush_work); in sm_release()
1105 mutex_unlock(&ftl->mutex); in sm_release()
1111 struct sm_ftl *ftl = dev->priv; in sm_getgeo()
1112 geo->heads = ftl->heads; in sm_getgeo()
1113 geo->sectors = ftl->sectors; in sm_getgeo()
1114 geo->cylinders = ftl->cylinders; in sm_getgeo()
1130 mutex_init(&ftl->mutex); in sm_add_mtd()
1131 timer_setup(&ftl->timer, sm_cache_flush_timer, 0); in sm_add_mtd()
1132 INIT_WORK(&ftl->flush_work, sm_cache_flush_work); in sm_add_mtd()
1142 ftl->cis_buffer = kzalloc(SM_SECTOR_SIZE, GFP_KERNEL); in sm_add_mtd()
1143 if (!ftl->cis_buffer) in sm_add_mtd()
1147 ftl->zones = kcalloc(ftl->zone_count, sizeof(struct ftl_zone), in sm_add_mtd()
1149 if (!ftl->zones) in sm_add_mtd()
1153 ftl->cache_data = kzalloc(ftl->block_size, GFP_KERNEL); in sm_add_mtd()
1155 if (!ftl->cache_data) in sm_add_mtd()
1166 ftl->trans = trans; in sm_add_mtd()
1167 trans->priv = ftl; in sm_add_mtd()
1169 trans->tr = tr; in sm_add_mtd()
1170 trans->mtd = mtd; in sm_add_mtd()
1171 trans->devnum = -1; in sm_add_mtd()
1172 trans->size = (ftl->block_size * ftl->max_lba * ftl->zone_count) >> 9; in sm_add_mtd()
1173 trans->readonly = ftl->readonly; in sm_add_mtd()
1180 ftl->disk_attributes = sm_create_sysfs_attributes(ftl); in sm_add_mtd()
1181 if (!ftl->disk_attributes) in sm_add_mtd()
1183 trans->disk_attributes = ftl->disk_attributes; in sm_add_mtd()
1186 (int)(mtd->size / (1024 * 1024)), mtd->index); in sm_add_mtd()
1190 ftl->zone_count, ftl->max_lba, in sm_add_mtd()
1191 ftl->zone_size - ftl->max_lba); in sm_add_mtd()
1193 ftl->block_size); in sm_add_mtd()
1205 kfree(ftl->cache_data); in sm_add_mtd()
1207 kfree(ftl->zones); in sm_add_mtd()
1209 kfree(ftl->cis_buffer); in sm_add_mtd()
1219 struct sm_ftl *ftl = dev->priv; in sm_remove_dev()
1223 ftl->trans = NULL; in sm_remove_dev()
1225 for (i = 0 ; i < ftl->zone_count; i++) { in sm_remove_dev()
1227 if (!ftl->zones[i].initialized) in sm_remove_dev()
1230 kfree(ftl->zones[i].lba_to_phys_table); in sm_remove_dev()
1231 kfifo_free(&ftl->zones[i].free_sectors); in sm_remove_dev()
1235 kfree(ftl->cis_buffer); in sm_remove_dev()
1236 kfree(ftl->zones); in sm_remove_dev()
1237 kfree(ftl->cache_data); in sm_remove_dev()
1266 return -ENOMEM; in sm_module_init()