^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * Copyright © 2009 - Maxim Levitsky
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) * SmartMedia/xD translation layer
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include <linux/random.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/hdreg.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/kthread.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/freezer.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/sysfs.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/bitops.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/mtd/nand_ecc.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include "nand/raw/sm_common.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include "sm_ftl.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) static struct workqueue_struct *cache_flush_workqueue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) static int cache_timeout = 1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) module_param(cache_timeout, int, S_IRUGO);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) MODULE_PARM_DESC(cache_timeout,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) "Timeout (in ms) for cache flush (1000 ms default");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) static int debug;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) module_param(debug, int, S_IRUGO | S_IWUSR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) MODULE_PARM_DESC(debug, "Debug level (0-2)");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) /* ------------------- sysfs attributes ---------------------------------- */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) struct sm_sysfs_attribute {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) struct device_attribute dev_attr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) char *data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) int len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) static ssize_t sm_attr_show(struct device *dev, struct device_attribute *attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) char *buf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) struct sm_sysfs_attribute *sm_attr =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) container_of(attr, struct sm_sysfs_attribute, dev_attr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) strncpy(buf, sm_attr->data, sm_attr->len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) return sm_attr->len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) #define NUM_ATTRIBUTES 1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) #define SM_CIS_VENDOR_OFFSET 0x59
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) static struct attribute_group *sm_create_sysfs_attributes(struct sm_ftl *ftl)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) struct attribute_group *attr_group;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) struct attribute **attributes;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) struct sm_sysfs_attribute *vendor_attribute;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) char *vendor;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) vendor = kstrndup(ftl->cis_buffer + SM_CIS_VENDOR_OFFSET,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) SM_SMALL_PAGE - SM_CIS_VENDOR_OFFSET, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) if (!vendor)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) goto error1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) /* Initialize sysfs attributes */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) vendor_attribute =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) kzalloc(sizeof(struct sm_sysfs_attribute), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) if (!vendor_attribute)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) goto error2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) sysfs_attr_init(&vendor_attribute->dev_attr.attr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) vendor_attribute->data = vendor;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) vendor_attribute->len = strlen(vendor);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) vendor_attribute->dev_attr.attr.name = "vendor";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) vendor_attribute->dev_attr.attr.mode = S_IRUGO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) vendor_attribute->dev_attr.show = sm_attr_show;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) /* Create array of pointers to the attributes */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) attributes = kcalloc(NUM_ATTRIBUTES + 1, sizeof(struct attribute *),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) if (!attributes)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) goto error3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) attributes[0] = &vendor_attribute->dev_attr.attr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) /* Finally create the attribute group */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) attr_group = kzalloc(sizeof(struct attribute_group), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) if (!attr_group)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) goto error4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) attr_group->attrs = attributes;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) return attr_group;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) error4:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) kfree(attributes);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) error3:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) kfree(vendor_attribute);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) error2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) kfree(vendor);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) error1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) static void sm_delete_sysfs_attributes(struct sm_ftl *ftl)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) struct attribute **attributes = ftl->disk_attributes->attrs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) for (i = 0; attributes[i] ; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) struct device_attribute *dev_attr = container_of(attributes[i],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) struct device_attribute, attr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) struct sm_sysfs_attribute *sm_attr =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) container_of(dev_attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) struct sm_sysfs_attribute, dev_attr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) kfree(sm_attr->data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) kfree(sm_attr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) kfree(ftl->disk_attributes->attrs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) kfree(ftl->disk_attributes);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) /* ----------------------- oob helpers -------------------------------------- */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) static int sm_get_lba(uint8_t *lba)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) /* check fixed bits */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) if ((lba[0] & 0xF8) != 0x10)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) return -2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) /* check parity - endianness doesn't matter */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) if (hweight16(*(uint16_t *)lba) & 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) return -2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) return (lba[1] >> 1) | ((lba[0] & 0x07) << 7);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) * Read LBA associated with block
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) * returns -1, if block is erased
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) * returns -2 if error happens
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) static int sm_read_lba(struct sm_oob *oob)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) static const uint32_t erased_pattern[4] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) uint16_t lba_test;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) int lba;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) /* First test for erased block */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) if (!memcmp(oob, erased_pattern, SM_OOB_SIZE))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) /* Now check is both copies of the LBA differ too much */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) lba_test = *(uint16_t *)oob->lba_copy1 ^ *(uint16_t*)oob->lba_copy2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) if (lba_test && !is_power_of_2(lba_test))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) return -2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) /* And read it */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) lba = sm_get_lba(oob->lba_copy1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) if (lba == -2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) lba = sm_get_lba(oob->lba_copy2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) return lba;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) static void sm_write_lba(struct sm_oob *oob, uint16_t lba)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) uint8_t tmp[2];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) WARN_ON(lba >= 1000);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) tmp[0] = 0x10 | ((lba >> 7) & 0x07);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) tmp[1] = (lba << 1) & 0xFF;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) if (hweight16(*(uint16_t *)tmp) & 0x01)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) tmp[1] |= 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) oob->lba_copy1[0] = oob->lba_copy2[0] = tmp[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) oob->lba_copy1[1] = oob->lba_copy2[1] = tmp[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) /* Make offset from parts */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) static loff_t sm_mkoffset(struct sm_ftl *ftl, int zone, int block, int boffset)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) WARN_ON(boffset & (SM_SECTOR_SIZE - 1));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) WARN_ON(zone < 0 || zone >= ftl->zone_count);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) WARN_ON(block >= ftl->zone_size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) WARN_ON(boffset >= ftl->block_size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) if (block == -1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) return (zone * SM_MAX_ZONE_SIZE + block) * ftl->block_size + boffset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) /* Breaks offset into parts */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) static void sm_break_offset(struct sm_ftl *ftl, loff_t loffset,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) int *zone, int *block, int *boffset)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) u64 offset = loffset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) *boffset = do_div(offset, ftl->block_size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) *block = do_div(offset, ftl->max_lba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) *zone = offset >= ftl->zone_count ? -1 : offset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) /* ---------------------- low level IO ------------------------------------- */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) static int sm_correct_sector(uint8_t *buffer, struct sm_oob *oob)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) uint8_t ecc[3];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) __nand_calculate_ecc(buffer, SM_SMALL_PAGE, ecc,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) IS_ENABLED(CONFIG_MTD_NAND_ECC_SW_HAMMING_SMC));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) if (__nand_correct_data(buffer, ecc, oob->ecc1, SM_SMALL_PAGE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) IS_ENABLED(CONFIG_MTD_NAND_ECC_SW_HAMMING_SMC)) < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) buffer += SM_SMALL_PAGE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) __nand_calculate_ecc(buffer, SM_SMALL_PAGE, ecc,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) IS_ENABLED(CONFIG_MTD_NAND_ECC_SW_HAMMING_SMC));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) if (__nand_correct_data(buffer, ecc, oob->ecc2, SM_SMALL_PAGE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) IS_ENABLED(CONFIG_MTD_NAND_ECC_SW_HAMMING_SMC)) < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) /* Reads a sector + oob*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) static int sm_read_sector(struct sm_ftl *ftl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) int zone, int block, int boffset,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) uint8_t *buffer, struct sm_oob *oob)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) struct mtd_info *mtd = ftl->trans->mtd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) struct mtd_oob_ops ops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) struct sm_oob tmp_oob;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) int ret = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) int try = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) /* FTL can contain -1 entries that are by default filled with bits */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) if (block == -1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) if (buffer)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) memset(buffer, 0xFF, SM_SECTOR_SIZE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) /* User might not need the oob, but we do for data verification */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) if (!oob)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) oob = &tmp_oob;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) ops.mode = ftl->smallpagenand ? MTD_OPS_RAW : MTD_OPS_PLACE_OOB;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) ops.ooboffs = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) ops.ooblen = SM_OOB_SIZE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) ops.oobbuf = (void *)oob;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) ops.len = SM_SECTOR_SIZE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) ops.datbuf = buffer;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) again:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) if (try++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) /* Avoid infinite recursion on CIS reads, sm_recheck_media
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) won't help anyway */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) if (zone == 0 && block == ftl->cis_block && boffset ==
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) ftl->cis_boffset)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) /* Test if media is stable */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) if (try == 3 || sm_recheck_media(ftl))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) /* Unfortunately, oob read will _always_ succeed,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) despite card removal..... */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) ret = mtd_read_oob(mtd, sm_mkoffset(ftl, zone, block, boffset), &ops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) /* Test for unknown errors */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) if (ret != 0 && !mtd_is_bitflip_or_eccerr(ret)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) dbg("read of block %d at zone %d, failed due to error (%d)",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) block, zone, ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) goto again;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) /* Do a basic test on the oob, to guard against returned garbage */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) if (oob->reserved != 0xFFFFFFFF && !is_power_of_2(~oob->reserved))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) goto again;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) /* This should never happen, unless there is a bug in the mtd driver */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) WARN_ON(ops.oobretlen != SM_OOB_SIZE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) WARN_ON(buffer && ops.retlen != SM_SECTOR_SIZE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) if (!buffer)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) /* Test if sector marked as bad */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) if (!sm_sector_valid(oob)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) dbg("read of block %d at zone %d, failed because it is marked"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) " as bad" , block, zone);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) goto again;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) /* Test ECC*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) if (mtd_is_eccerr(ret) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) (ftl->smallpagenand && sm_correct_sector(buffer, oob))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) dbg("read of block %d at zone %d, failed due to ECC error",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) block, zone);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) goto again;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) /* Writes a sector to media */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) static int sm_write_sector(struct sm_ftl *ftl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) int zone, int block, int boffset,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) uint8_t *buffer, struct sm_oob *oob)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) struct mtd_oob_ops ops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) struct mtd_info *mtd = ftl->trans->mtd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) BUG_ON(ftl->readonly);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) if (zone == 0 && (block == ftl->cis_block || block == 0)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) dbg("attempted to write the CIS!");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) if (ftl->unstable)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) ops.mode = ftl->smallpagenand ? MTD_OPS_RAW : MTD_OPS_PLACE_OOB;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) ops.len = SM_SECTOR_SIZE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) ops.datbuf = buffer;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) ops.ooboffs = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) ops.ooblen = SM_OOB_SIZE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) ops.oobbuf = (void *)oob;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) ret = mtd_write_oob(mtd, sm_mkoffset(ftl, zone, block, boffset), &ops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) /* Now we assume that hardware will catch write bitflip errors */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) dbg("write to block %d at zone %d, failed with error %d",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) block, zone, ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) sm_recheck_media(ftl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) /* This should never happen, unless there is a bug in the driver */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) WARN_ON(ops.oobretlen != SM_OOB_SIZE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) WARN_ON(buffer && ops.retlen != SM_SECTOR_SIZE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) /* ------------------------ block IO ------------------------------------- */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) /* Write a block using data and lba, and invalid sector bitmap */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) static int sm_write_block(struct sm_ftl *ftl, uint8_t *buf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) int zone, int block, int lba,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) unsigned long invalid_bitmap)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) struct sm_oob oob;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) int boffset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) int retry = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) /* Initialize the oob with requested values */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) memset(&oob, 0xFF, SM_OOB_SIZE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) sm_write_lba(&oob, lba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) restart:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) if (ftl->unstable)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) for (boffset = 0; boffset < ftl->block_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) boffset += SM_SECTOR_SIZE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) oob.data_status = 0xFF;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) if (test_bit(boffset / SM_SECTOR_SIZE, &invalid_bitmap)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) sm_printk("sector %d of block at LBA %d of zone %d"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) " couldn't be read, marking it as invalid",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) boffset / SM_SECTOR_SIZE, lba, zone);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) oob.data_status = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) if (ftl->smallpagenand) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) __nand_calculate_ecc(buf + boffset, SM_SMALL_PAGE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) oob.ecc1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) IS_ENABLED(CONFIG_MTD_NAND_ECC_SW_HAMMING_SMC));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) __nand_calculate_ecc(buf + boffset + SM_SMALL_PAGE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) SM_SMALL_PAGE, oob.ecc2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) IS_ENABLED(CONFIG_MTD_NAND_ECC_SW_HAMMING_SMC));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) if (!sm_write_sector(ftl, zone, block, boffset,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) buf + boffset, &oob))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) if (!retry) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) /* If write fails. try to erase the block */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) /* This is safe, because we never write in blocks
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) that contain valuable data.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) This is intended to repair block that are marked
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) as erased, but that isn't fully erased*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) if (sm_erase_block(ftl, zone, block, 0))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) retry = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) goto restart;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) sm_mark_block_bad(ftl, zone, block);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) /* Mark whole block at offset 'offs' as bad. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) static void sm_mark_block_bad(struct sm_ftl *ftl, int zone, int block)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) struct sm_oob oob;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) int boffset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) memset(&oob, 0xFF, SM_OOB_SIZE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) oob.block_status = 0xF0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) if (ftl->unstable)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) if (sm_recheck_media(ftl))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) sm_printk("marking block %d of zone %d as bad", block, zone);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) /* We aren't checking the return value, because we don't care */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) /* This also fails on fake xD cards, but I guess these won't expose
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) any bad blocks till fail completely */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) for (boffset = 0; boffset < ftl->block_size; boffset += SM_SECTOR_SIZE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) sm_write_sector(ftl, zone, block, boffset, NULL, &oob);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) * Erase a block within a zone
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) * If erase succeeds, it updates free block fifo, otherwise marks block as bad
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) static int sm_erase_block(struct sm_ftl *ftl, int zone_num, uint16_t block,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) int put_free)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) struct ftl_zone *zone = &ftl->zones[zone_num];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) struct mtd_info *mtd = ftl->trans->mtd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) struct erase_info erase;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) erase.addr = sm_mkoffset(ftl, zone_num, block, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) erase.len = ftl->block_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) if (ftl->unstable)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) BUG_ON(ftl->readonly);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) if (zone_num == 0 && (block == ftl->cis_block || block == 0)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) sm_printk("attempted to erase the CIS!");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) if (mtd_erase(mtd, &erase)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) sm_printk("erase of block %d in zone %d failed",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) block, zone_num);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) goto error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) if (put_free)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) kfifo_in(&zone->free_sectors,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) (const unsigned char *)&block, sizeof(block));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) error:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) sm_mark_block_bad(ftl, zone_num, block);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) /* Thoroughly test that block is valid. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) static int sm_check_block(struct sm_ftl *ftl, int zone, int block)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) int boffset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) struct sm_oob oob;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) int lbas[] = { -3, 0, 0, 0 };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) int i = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503) int test_lba;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506) /* First just check that block doesn't look fishy */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) /* Only blocks that are valid or are sliced in two parts, are
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) accepted */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) for (boffset = 0; boffset < ftl->block_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) boffset += SM_SECTOR_SIZE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) /* This shouldn't happen anyway */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) if (sm_read_sector(ftl, zone, block, boffset, NULL, &oob))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514) return -2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516) test_lba = sm_read_lba(&oob);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518) if (lbas[i] != test_lba)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) lbas[++i] = test_lba;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521) /* If we found three different LBAs, something is fishy */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) if (i == 3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) /* If the block is sliced (partially erased usually) erase it */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) if (i == 2) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528) sm_erase_block(ftl, zone, block, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) /* ----------------- media scanning --------------------------------- */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) static const struct chs_entry chs_table[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) { 1, 125, 4, 4 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538) { 2, 125, 4, 8 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539) { 4, 250, 4, 8 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) { 8, 250, 4, 16 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) { 16, 500, 4, 16 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) { 32, 500, 8, 16 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543) { 64, 500, 8, 32 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) { 128, 500, 16, 32 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) { 256, 1000, 16, 32 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) { 512, 1015, 32, 63 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547) { 1024, 985, 33, 63 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) { 2048, 985, 33, 63 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549) { 0 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553) static const uint8_t cis_signature[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554) 0x01, 0x03, 0xD9, 0x01, 0xFF, 0x18, 0x02, 0xDF, 0x01, 0x20
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556) /* Find out media parameters.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557) * This ideally has to be based on nand id, but for now device size is enough */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) static int sm_get_media_info(struct sm_ftl *ftl, struct mtd_info *mtd)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) int size_in_megs = mtd->size / (1024 * 1024);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) ftl->readonly = mtd->type == MTD_ROM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565) /* Manual settings for very old devices */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) ftl->zone_count = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567) ftl->smallpagenand = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569) switch (size_in_megs) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570) case 1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571) /* 1 MiB flash/rom SmartMedia card (256 byte pages)*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572) ftl->zone_size = 256;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573) ftl->max_lba = 250;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574) ftl->block_size = 8 * SM_SECTOR_SIZE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575) ftl->smallpagenand = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578) case 2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579) /* 2 MiB flash SmartMedia (256 byte pages)*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580) if (mtd->writesize == SM_SMALL_PAGE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581) ftl->zone_size = 512;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582) ftl->max_lba = 500;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583) ftl->block_size = 8 * SM_SECTOR_SIZE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584) ftl->smallpagenand = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585) /* 2 MiB rom SmartMedia */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 588) if (!ftl->readonly)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 589) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 590)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 591) ftl->zone_size = 256;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 592) ftl->max_lba = 250;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 593) ftl->block_size = 16 * SM_SECTOR_SIZE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 594) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 595) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 596) case 4:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 597) /* 4 MiB flash/rom SmartMedia device */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 598) ftl->zone_size = 512;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 599) ftl->max_lba = 500;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 600) ftl->block_size = 16 * SM_SECTOR_SIZE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 601) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 602) case 8:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 603) /* 8 MiB flash/rom SmartMedia device */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 604) ftl->zone_size = 1024;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 605) ftl->max_lba = 1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 606) ftl->block_size = 16 * SM_SECTOR_SIZE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 607) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 608)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 609) /* Minimum xD size is 16MiB. Also, all xD cards have standard zone
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 610) sizes. SmartMedia cards exist up to 128 MiB and have same layout*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 611) if (size_in_megs >= 16) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 612) ftl->zone_count = size_in_megs / 16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 613) ftl->zone_size = 1024;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 614) ftl->max_lba = 1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 615) ftl->block_size = 32 * SM_SECTOR_SIZE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 616) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 617)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 618) /* Test for proper write,erase and oob sizes */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 619) if (mtd->erasesize > ftl->block_size)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 620) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 621)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 622) if (mtd->writesize > SM_SECTOR_SIZE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 623) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 624)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 625) if (ftl->smallpagenand && mtd->oobsize < SM_SMALL_OOB_SIZE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 626) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 627)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 628) if (!ftl->smallpagenand && mtd->oobsize < SM_OOB_SIZE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 629) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 630)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 631) /* We use OOB */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 632) if (!mtd_has_oob(mtd))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 633) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 634)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 635) /* Find geometry information */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 636) for (i = 0 ; i < ARRAY_SIZE(chs_table) ; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 637) if (chs_table[i].size == size_in_megs) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 638) ftl->cylinders = chs_table[i].cyl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 639) ftl->heads = chs_table[i].head;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 640) ftl->sectors = chs_table[i].sec;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 641) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 642) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 643) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 644)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 645) sm_printk("media has unknown size : %dMiB", size_in_megs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 646) ftl->cylinders = 985;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 647) ftl->heads = 33;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 648) ftl->sectors = 63;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 649) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 650) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 651)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 652) /* Validate the CIS */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 653) static int sm_read_cis(struct sm_ftl *ftl)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 654) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 655) struct sm_oob oob;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 656)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 657) if (sm_read_sector(ftl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 658) 0, ftl->cis_block, ftl->cis_boffset, ftl->cis_buffer, &oob))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 659) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 660)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 661) if (!sm_sector_valid(&oob) || !sm_block_valid(&oob))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 662) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 663)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 664) if (!memcmp(ftl->cis_buffer + ftl->cis_page_offset,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 665) cis_signature, sizeof(cis_signature))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 666) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 667) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 668)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 669) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 670) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 671)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 672) /* Scan the media for the CIS */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 673) static int sm_find_cis(struct sm_ftl *ftl)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 674) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 675) struct sm_oob oob;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 676) int block, boffset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 677) int block_found = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 678) int cis_found = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 679)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 680) /* Search for first valid block */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 681) for (block = 0 ; block < ftl->zone_size - ftl->max_lba ; block++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 682)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 683) if (sm_read_sector(ftl, 0, block, 0, NULL, &oob))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 684) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 685)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 686) if (!sm_block_valid(&oob))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 687) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 688) block_found = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 689) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 690) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 691)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 692) if (!block_found)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 693) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 694)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 695) /* Search for first valid sector in this block */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 696) for (boffset = 0 ; boffset < ftl->block_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 697) boffset += SM_SECTOR_SIZE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 698)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 699) if (sm_read_sector(ftl, 0, block, boffset, NULL, &oob))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 700) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 701)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 702) if (!sm_sector_valid(&oob))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 703) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 704) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 705) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 706)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 707) if (boffset == ftl->block_size)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 708) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 709)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 710) ftl->cis_block = block;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 711) ftl->cis_boffset = boffset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 712) ftl->cis_page_offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 713)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 714) cis_found = !sm_read_cis(ftl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 715)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 716) if (!cis_found) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 717) ftl->cis_page_offset = SM_SMALL_PAGE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 718) cis_found = !sm_read_cis(ftl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 719) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 720)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 721) if (cis_found) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 722) dbg("CIS block found at offset %x",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 723) block * ftl->block_size +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 724) boffset + ftl->cis_page_offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 725) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 726) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 727) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 728) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 729)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 730) /* Basic test to determine if underlying mtd device if functional */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 731) static int sm_recheck_media(struct sm_ftl *ftl)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 732) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 733) if (sm_read_cis(ftl)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 734)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 735) if (!ftl->unstable) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 736) sm_printk("media unstable, not allowing writes");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 737) ftl->unstable = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 738) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 739) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 740) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 741) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 742) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 743)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 744) /* Initialize a FTL zone */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 745) static int sm_init_zone(struct sm_ftl *ftl, int zone_num)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 746) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 747) struct ftl_zone *zone = &ftl->zones[zone_num];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 748) struct sm_oob oob;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 749) uint16_t block;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 750) int lba;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 751) int i = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 752) int len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 753)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 754) dbg("initializing zone %d", zone_num);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 755)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 756) /* Allocate memory for FTL table */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 757) zone->lba_to_phys_table = kmalloc_array(ftl->max_lba, 2, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 758)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 759) if (!zone->lba_to_phys_table)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 760) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 761) memset(zone->lba_to_phys_table, -1, ftl->max_lba * 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 762)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 763)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 764) /* Allocate memory for free sectors FIFO */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 765) if (kfifo_alloc(&zone->free_sectors, ftl->zone_size * 2, GFP_KERNEL)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 766) kfree(zone->lba_to_phys_table);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 767) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 768) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 769)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 770) /* Now scan the zone */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 771) for (block = 0 ; block < ftl->zone_size ; block++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 772)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 773) /* Skip blocks till the CIS (including) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 774) if (zone_num == 0 && block <= ftl->cis_block)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 775) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 776)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 777) /* Read the oob of first sector */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 778) if (sm_read_sector(ftl, zone_num, block, 0, NULL, &oob)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 779) kfifo_free(&zone->free_sectors);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 780) kfree(zone->lba_to_phys_table);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 781) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 782) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 783)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 784) /* Test to see if block is erased. It is enough to test
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 785) first sector, because erase happens in one shot */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 786) if (sm_block_erased(&oob)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 787) kfifo_in(&zone->free_sectors,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 788) (unsigned char *)&block, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 789) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 790) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 791)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 792) /* If block is marked as bad, skip it */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 793) /* This assumes we can trust first sector*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 794) /* However the way the block valid status is defined, ensures
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 795) very low probability of failure here */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 796) if (!sm_block_valid(&oob)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 797) dbg("PH %04d <-> <marked bad>", block);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 798) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 799) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 800)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 801)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 802) lba = sm_read_lba(&oob);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 803)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 804) /* Invalid LBA means that block is damaged. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 805) /* We can try to erase it, or mark it as bad, but
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 806) lets leave that to recovery application */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 807) if (lba == -2 || lba >= ftl->max_lba) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 808) dbg("PH %04d <-> LBA %04d(bad)", block, lba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 809) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 810) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 811)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 812)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 813) /* If there is no collision,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 814) just put the sector in the FTL table */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 815) if (zone->lba_to_phys_table[lba] < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 816) dbg_verbose("PH %04d <-> LBA %04d", block, lba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 817) zone->lba_to_phys_table[lba] = block;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 818) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 819) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 820)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 821) sm_printk("collision"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 822) " of LBA %d between blocks %d and %d in zone %d",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 823) lba, zone->lba_to_phys_table[lba], block, zone_num);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 824)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 825) /* Test that this block is valid*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 826) if (sm_check_block(ftl, zone_num, block))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 827) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 828)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 829) /* Test now the old block */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 830) if (sm_check_block(ftl, zone_num,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 831) zone->lba_to_phys_table[lba])) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 832) zone->lba_to_phys_table[lba] = block;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 833) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 834) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 835)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 836) /* If both blocks are valid and share same LBA, it means that
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 837) they hold different versions of same data. It not
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 838) known which is more recent, thus just erase one of them
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 839) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 840) sm_printk("both blocks are valid, erasing the later");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 841) sm_erase_block(ftl, zone_num, block, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 842) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 843)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 844) dbg("zone initialized");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 845) zone->initialized = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 846)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 847) /* No free sectors, means that the zone is heavily damaged, write won't
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 848) work, but it can still can be (partially) read */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 849) if (!kfifo_len(&zone->free_sectors)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 850) sm_printk("no free blocks in zone %d", zone_num);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 851) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 852) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 853)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 854) /* Randomize first block we write to */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 855) get_random_bytes(&i, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 856) i %= (kfifo_len(&zone->free_sectors) / 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 857)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 858) while (i--) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 859) len = kfifo_out(&zone->free_sectors,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 860) (unsigned char *)&block, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 861) WARN_ON(len != 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 862) kfifo_in(&zone->free_sectors, (const unsigned char *)&block, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 863) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 864) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 865) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 866)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 867) /* Get and automatically initialize an FTL mapping for one zone */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 868) static struct ftl_zone *sm_get_zone(struct sm_ftl *ftl, int zone_num)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 869) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 870) struct ftl_zone *zone;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 871) int error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 872)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 873) BUG_ON(zone_num >= ftl->zone_count);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 874) zone = &ftl->zones[zone_num];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 875)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 876) if (!zone->initialized) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 877) error = sm_init_zone(ftl, zone_num);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 878)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 879) if (error)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 880) return ERR_PTR(error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 881) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 882) return zone;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 883) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 884)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 885)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 886) /* ----------------- cache handling ------------------------------------------*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 887)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 888) /* Initialize the one block cache */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 889) static void sm_cache_init(struct sm_ftl *ftl)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 890) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 891) ftl->cache_data_invalid_bitmap = 0xFFFFFFFF;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 892) ftl->cache_clean = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 893) ftl->cache_zone = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 894) ftl->cache_block = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 895) /*memset(ftl->cache_data, 0xAA, ftl->block_size);*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 896) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 897)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 898) /* Put sector in one block cache */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 899) static void sm_cache_put(struct sm_ftl *ftl, char *buffer, int boffset)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 900) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 901) memcpy(ftl->cache_data + boffset, buffer, SM_SECTOR_SIZE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 902) clear_bit(boffset / SM_SECTOR_SIZE, &ftl->cache_data_invalid_bitmap);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 903) ftl->cache_clean = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 904) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 905)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 906) /* Read a sector from the cache */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 907) static int sm_cache_get(struct sm_ftl *ftl, char *buffer, int boffset)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 908) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 909) if (test_bit(boffset / SM_SECTOR_SIZE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 910) &ftl->cache_data_invalid_bitmap))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 911) return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 912)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 913) memcpy(buffer, ftl->cache_data + boffset, SM_SECTOR_SIZE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 914) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 915) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 916)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 917) /* Write the cache to hardware */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 918) static int sm_cache_flush(struct sm_ftl *ftl)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 919) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 920) struct ftl_zone *zone;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 921)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 922) int sector_num;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 923) uint16_t write_sector;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 924) int zone_num = ftl->cache_zone;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 925) int block_num;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 926)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 927) if (ftl->cache_clean)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 928) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 929)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 930) if (ftl->unstable)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 931) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 932)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 933) BUG_ON(zone_num < 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 934) zone = &ftl->zones[zone_num];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 935) block_num = zone->lba_to_phys_table[ftl->cache_block];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 936)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 937)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 938) /* Try to read all unread areas of the cache block*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 939) for_each_set_bit(sector_num, &ftl->cache_data_invalid_bitmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 940) ftl->block_size / SM_SECTOR_SIZE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 941)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 942) if (!sm_read_sector(ftl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 943) zone_num, block_num, sector_num * SM_SECTOR_SIZE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 944) ftl->cache_data + sector_num * SM_SECTOR_SIZE, NULL))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 945) clear_bit(sector_num,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 946) &ftl->cache_data_invalid_bitmap);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 947) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 948) restart:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 949)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 950) if (ftl->unstable)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 951) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 952)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 953) /* If there are no spare blocks, */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 954) /* we could still continue by erasing/writing the current block,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 955) but for such worn out media it doesn't worth the trouble,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 956) and the dangers */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 957) if (kfifo_out(&zone->free_sectors,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 958) (unsigned char *)&write_sector, 2) != 2) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 959) dbg("no free sectors for write!");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 960) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 961) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 962)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 963)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 964) if (sm_write_block(ftl, ftl->cache_data, zone_num, write_sector,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 965) ftl->cache_block, ftl->cache_data_invalid_bitmap))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 966) goto restart;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 967)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 968) /* Update the FTL table */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 969) zone->lba_to_phys_table[ftl->cache_block] = write_sector;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 970)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 971) /* Write succesfull, so erase and free the old block */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 972) if (block_num > 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 973) sm_erase_block(ftl, zone_num, block_num, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 974)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 975) sm_cache_init(ftl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 976) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 977) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 978)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 979)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 980) /* flush timer, runs a second after last write */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 981) static void sm_cache_flush_timer(struct timer_list *t)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 982) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 983) struct sm_ftl *ftl = from_timer(ftl, t, timer);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 984) queue_work(cache_flush_workqueue, &ftl->flush_work);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 985) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 986)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 987) /* cache flush work, kicked by timer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 988) static void sm_cache_flush_work(struct work_struct *work)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 989) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 990) struct sm_ftl *ftl = container_of(work, struct sm_ftl, flush_work);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 991) mutex_lock(&ftl->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 992) sm_cache_flush(ftl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 993) mutex_unlock(&ftl->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 994) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 995) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 996)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 997) /* ---------------- outside interface -------------------------------------- */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 998)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 999) /* outside interface: read a sector */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1000) static int sm_read(struct mtd_blktrans_dev *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1001) unsigned long sect_no, char *buf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1002) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1003) struct sm_ftl *ftl = dev->priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1004) struct ftl_zone *zone;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1005) int error = 0, in_cache = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1006) int zone_num, block, boffset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1007)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1008) sm_break_offset(ftl, sect_no << 9, &zone_num, &block, &boffset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1009) mutex_lock(&ftl->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1010)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1011)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1012) zone = sm_get_zone(ftl, zone_num);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1013) if (IS_ERR(zone)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1014) error = PTR_ERR(zone);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1015) goto unlock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1016) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1017)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1018) /* Have to look at cache first */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1019) if (ftl->cache_zone == zone_num && ftl->cache_block == block) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1020) in_cache = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1021) if (!sm_cache_get(ftl, buf, boffset))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1022) goto unlock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1023) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1024)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1025) /* Translate the block and return if doesn't exist in the table */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1026) block = zone->lba_to_phys_table[block];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1027)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1028) if (block == -1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1029) memset(buf, 0xFF, SM_SECTOR_SIZE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1030) goto unlock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1031) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1032)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1033) if (sm_read_sector(ftl, zone_num, block, boffset, buf, NULL)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1034) error = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1035) goto unlock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1036) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1037)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1038) if (in_cache)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1039) sm_cache_put(ftl, buf, boffset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1040) unlock:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1041) mutex_unlock(&ftl->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1042) return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1043) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1044)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1045) /* outside interface: write a sector */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1046) static int sm_write(struct mtd_blktrans_dev *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1047) unsigned long sec_no, char *buf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1048) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1049) struct sm_ftl *ftl = dev->priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1050) struct ftl_zone *zone;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1051) int error = 0, zone_num, block, boffset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1052)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1053) BUG_ON(ftl->readonly);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1054) sm_break_offset(ftl, sec_no << 9, &zone_num, &block, &boffset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1055)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1056) /* No need in flush thread running now */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1057) del_timer(&ftl->timer);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1058) mutex_lock(&ftl->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1059)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1060) zone = sm_get_zone(ftl, zone_num);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1061) if (IS_ERR(zone)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1062) error = PTR_ERR(zone);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1063) goto unlock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1064) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1065)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1066) /* If entry is not in cache, flush it */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1067) if (ftl->cache_block != block || ftl->cache_zone != zone_num) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1068)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1069) error = sm_cache_flush(ftl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1070) if (error)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1071) goto unlock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1072)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1073) ftl->cache_block = block;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1074) ftl->cache_zone = zone_num;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1075) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1076)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1077) sm_cache_put(ftl, buf, boffset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1078) unlock:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1079) mod_timer(&ftl->timer, jiffies + msecs_to_jiffies(cache_timeout));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1080) mutex_unlock(&ftl->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1081) return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1082) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1083)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1084) /* outside interface: flush everything */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1085) static int sm_flush(struct mtd_blktrans_dev *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1086) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1087) struct sm_ftl *ftl = dev->priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1088) int retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1089)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1090) mutex_lock(&ftl->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1091) retval = sm_cache_flush(ftl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1092) mutex_unlock(&ftl->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1093) return retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1094) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1095)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1096) /* outside interface: device is released */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1097) static void sm_release(struct mtd_blktrans_dev *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1098) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1099) struct sm_ftl *ftl = dev->priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1100)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1101) mutex_lock(&ftl->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1102) del_timer_sync(&ftl->timer);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1103) cancel_work_sync(&ftl->flush_work);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1104) sm_cache_flush(ftl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1105) mutex_unlock(&ftl->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1106) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1107)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1108) /* outside interface: get geometry */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1109) static int sm_getgeo(struct mtd_blktrans_dev *dev, struct hd_geometry *geo)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1110) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1111) struct sm_ftl *ftl = dev->priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1112) geo->heads = ftl->heads;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1113) geo->sectors = ftl->sectors;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1114) geo->cylinders = ftl->cylinders;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1115) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1116) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1117)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1118) /* external interface: main initialization function */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1119) static void sm_add_mtd(struct mtd_blktrans_ops *tr, struct mtd_info *mtd)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1120) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1121) struct mtd_blktrans_dev *trans;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1122) struct sm_ftl *ftl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1123)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1124) /* Allocate & initialize our private structure */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1125) ftl = kzalloc(sizeof(struct sm_ftl), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1126) if (!ftl)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1127) goto error1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1128)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1129)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1130) mutex_init(&ftl->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1131) timer_setup(&ftl->timer, sm_cache_flush_timer, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1132) INIT_WORK(&ftl->flush_work, sm_cache_flush_work);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1133)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1134) /* Read media information */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1135) if (sm_get_media_info(ftl, mtd)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1136) dbg("found unsupported mtd device, aborting");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1137) goto error2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1138) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1139)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1140)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1141) /* Allocate temporary CIS buffer for read retry support */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1142) ftl->cis_buffer = kzalloc(SM_SECTOR_SIZE, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1143) if (!ftl->cis_buffer)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1144) goto error2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1145)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1146) /* Allocate zone array, it will be initialized on demand */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1147) ftl->zones = kcalloc(ftl->zone_count, sizeof(struct ftl_zone),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1148) GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1149) if (!ftl->zones)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1150) goto error3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1151)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1152) /* Allocate the cache*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1153) ftl->cache_data = kzalloc(ftl->block_size, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1154)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1155) if (!ftl->cache_data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1156) goto error4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1157)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1158) sm_cache_init(ftl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1159)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1160)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1161) /* Allocate upper layer structure and initialize it */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1162) trans = kzalloc(sizeof(struct mtd_blktrans_dev), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1163) if (!trans)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1164) goto error5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1165)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1166) ftl->trans = trans;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1167) trans->priv = ftl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1168)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1169) trans->tr = tr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1170) trans->mtd = mtd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1171) trans->devnum = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1172) trans->size = (ftl->block_size * ftl->max_lba * ftl->zone_count) >> 9;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1173) trans->readonly = ftl->readonly;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1174)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1175) if (sm_find_cis(ftl)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1176) dbg("CIS not found on mtd device, aborting");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1177) goto error6;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1178) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1179)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1180) ftl->disk_attributes = sm_create_sysfs_attributes(ftl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1181) if (!ftl->disk_attributes)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1182) goto error6;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1183) trans->disk_attributes = ftl->disk_attributes;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1184)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1185) sm_printk("Found %d MiB xD/SmartMedia FTL on mtd%d",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1186) (int)(mtd->size / (1024 * 1024)), mtd->index);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1187)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1188) dbg("FTL layout:");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1189) dbg("%d zone(s), each consists of %d blocks (+%d spares)",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1190) ftl->zone_count, ftl->max_lba,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1191) ftl->zone_size - ftl->max_lba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1192) dbg("each block consists of %d bytes",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1193) ftl->block_size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1194)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1195)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1196) /* Register device*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1197) if (add_mtd_blktrans_dev(trans)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1198) dbg("error in mtdblktrans layer");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1199) goto error6;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1200) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1201) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1202) error6:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1203) kfree(trans);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1204) error5:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1205) kfree(ftl->cache_data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1206) error4:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1207) kfree(ftl->zones);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1208) error3:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1209) kfree(ftl->cis_buffer);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1210) error2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1211) kfree(ftl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1212) error1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1213) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1214) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1215)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1216) /* main interface: device {surprise,} removal */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1217) static void sm_remove_dev(struct mtd_blktrans_dev *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1218) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1219) struct sm_ftl *ftl = dev->priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1220) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1221)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1222) del_mtd_blktrans_dev(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1223) ftl->trans = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1224)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1225) for (i = 0 ; i < ftl->zone_count; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1226)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1227) if (!ftl->zones[i].initialized)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1228) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1229)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1230) kfree(ftl->zones[i].lba_to_phys_table);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1231) kfifo_free(&ftl->zones[i].free_sectors);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1232) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1233)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1234) sm_delete_sysfs_attributes(ftl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1235) kfree(ftl->cis_buffer);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1236) kfree(ftl->zones);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1237) kfree(ftl->cache_data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1238) kfree(ftl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1239) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1240)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1241) static struct mtd_blktrans_ops sm_ftl_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1242) .name = "smblk",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1243) .major = 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1244) .part_bits = SM_FTL_PARTN_BITS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1245) .blksize = SM_SECTOR_SIZE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1246) .getgeo = sm_getgeo,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1247)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1248) .add_mtd = sm_add_mtd,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1249) .remove_dev = sm_remove_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1250)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1251) .readsect = sm_read,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1252) .writesect = sm_write,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1253)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1254) .flush = sm_flush,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1255) .release = sm_release,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1256)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1257) .owner = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1258) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1259)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1260) static __init int sm_module_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1261) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1262) int error = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1263)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1264) cache_flush_workqueue = create_freezable_workqueue("smflush");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1265) if (!cache_flush_workqueue)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1266) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1267)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1268) error = register_mtd_blktrans(&sm_ftl_ops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1269) if (error)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1270) destroy_workqueue(cache_flush_workqueue);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1271) return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1272)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1273) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1274)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1275) static void __exit sm_module_exit(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1276) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1277) destroy_workqueue(cache_flush_workqueue);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1278) deregister_mtd_blktrans(&sm_ftl_ops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1279) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1280)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1281) module_init(sm_module_init);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1282) module_exit(sm_module_exit);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1283)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1284) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1285) MODULE_AUTHOR("Maxim Levitsky <maximlevitsky@gmail.com>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1286) MODULE_DESCRIPTION("Smartmedia/xD mtd translation layer");
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags