diff options
| -rw-r--r-- | Documentation/blockdev/00-INDEX | 2 | ||||
| -rw-r--r-- | Documentation/blockdev/mflash.txt | 84 | ||||
| -rw-r--r-- | drivers/block/Kconfig | 17 | ||||
| -rw-r--r-- | drivers/block/Makefile | 1 | ||||
| -rw-r--r-- | drivers/block/mg_disk.c | 1005 | ||||
| -rw-r--r-- | include/linux/mg_disk.h | 206 |
6 files changed, 1315 insertions, 0 deletions
diff --git a/Documentation/blockdev/00-INDEX b/Documentation/blockdev/00-INDEX index 86f054c47013..c08df56dd91b 100644 --- a/Documentation/blockdev/00-INDEX +++ b/Documentation/blockdev/00-INDEX | |||
| @@ -8,6 +8,8 @@ cpqarray.txt | |||
| 8 | - info on using Compaq's SMART2 Intelligent Disk Array Controllers. | 8 | - info on using Compaq's SMART2 Intelligent Disk Array Controllers. |
| 9 | floppy.txt | 9 | floppy.txt |
| 10 | - notes and driver options for the floppy disk driver. | 10 | - notes and driver options for the floppy disk driver. |
| 11 | mflash.txt | ||
| 12 | - info on mGine m(g)flash driver for linux. | ||
| 11 | nbd.txt | 13 | nbd.txt |
| 12 | - info on a TCP implementation of a network block device. | 14 | - info on a TCP implementation of a network block device. |
| 13 | paride.txt | 15 | paride.txt |
diff --git a/Documentation/blockdev/mflash.txt b/Documentation/blockdev/mflash.txt new file mode 100644 index 000000000000..1f610ecf698a --- /dev/null +++ b/Documentation/blockdev/mflash.txt | |||
| @@ -0,0 +1,84 @@ | |||
| 1 | This document describes m[g]flash support in linux. | ||
| 2 | |||
| 3 | Contents | ||
| 4 | 1. Overview | ||
| 5 | 2. Reserved area configuration | ||
| 6 | 3. Example of mflash platform driver registration | ||
| 7 | |||
| 8 | 1. Overview | ||
| 9 | |||
| 10 | Mflash and gflash are embedded flash drive. The only difference is mflash is | ||
| 11 | MCP(Multi Chip Package) device. These two device operate exactly same way. | ||
| 12 | So the rest mflash repersents mflash and gflash altogether. | ||
| 13 | |||
| 14 | Internally, mflash has nand flash and other hardware logics and supports | ||
| 15 | 2 different operation (ATA, IO) modes. ATA mode doesn't need any new | ||
| 16 | driver and currently works well under standard IDE subsystem. Actually it's | ||
| 17 | one chip SSD. IO mode is ATA-like custom mode for the host that doesn't have | ||
| 18 | IDE interface. | ||
| 19 | |||
| 20 | Followings are brief descriptions about IO mode. | ||
| 21 | A. IO mode based on ATA protocol and uses some custom command. (read confirm, | ||
| 22 | write confirm) | ||
| 23 | B. IO mode uses SRAM bus interface. | ||
| 24 | C. IO mode supports 4kB boot area, so host can boot from mflash. | ||
| 25 | |||
| 26 | 2. Reserved area configuration | ||
| 27 | If host boot from mflash, usually needs raw area for boot loader image. All of | ||
| 28 | the mflash's block device operation will be taken this value as start offset. | ||
| 29 | Note that boot loader's size of reserved area and kernel configuration value | ||
| 30 | must be same. | ||
| 31 | |||
| 32 | 3. Example of mflash platform driver registration | ||
| 33 | Working mflash is very straight forward. Adding platform device stuff to board | ||
| 34 | configuration file is all. Here is some pseudo example. | ||
| 35 | |||
| 36 | static struct mg_drv_data mflash_drv_data = { | ||
| 37 | /* If you want to polling driver set to 1 */ | ||
| 38 | .use_polling = 0, | ||
| 39 | /* device attribution */ | ||
| 40 | .dev_attr = MG_BOOT_DEV | ||
| 41 | }; | ||
| 42 | |||
| 43 | static struct resource mg_mflash_rsc[] = { | ||
| 44 | /* Base address of mflash */ | ||
| 45 | [0] = { | ||
| 46 | .start = 0x08000000, | ||
| 47 | .end = 0x08000000 + SZ_64K - 1, | ||
| 48 | .flags = IORESOURCE_MEM | ||
| 49 | }, | ||
| 50 | /* mflash interrupt pin */ | ||
| 51 | [1] = { | ||
| 52 | .start = IRQ_GPIO(84), | ||
| 53 | .end = IRQ_GPIO(84), | ||
| 54 | .flags = IORESOURCE_IRQ | ||
| 55 | }, | ||
| 56 | /* mflash reset pin */ | ||
| 57 | [2] = { | ||
| 58 | .start = 43, | ||
| 59 | .end = 43, | ||
| 60 | .name = MG_RST_PIN, | ||
| 61 | .flags = IORESOURCE_IO | ||
| 62 | }, | ||
| 63 | /* mflash reset-out pin | ||
| 64 | * If you use mflash as storage device (i.e. other than MG_BOOT_DEV), | ||
| 65 | * should assign this */ | ||
| 66 | [3] = { | ||
| 67 | .start = 51, | ||
| 68 | .end = 51, | ||
| 69 | .name = MG_RSTOUT_PIN, | ||
| 70 | .flags = IORESOURCE_IO | ||
| 71 | } | ||
| 72 | }; | ||
| 73 | |||
| 74 | static struct platform_device mflash_dev = { | ||
| 75 | .name = MG_DEV_NAME, | ||
| 76 | .id = -1, | ||
| 77 | .dev = { | ||
| 78 | .platform_data = &mflash_drv_data, | ||
| 79 | }, | ||
| 80 | .num_resources = ARRAY_SIZE(mg_mflash_rsc), | ||
| 81 | .resource = mg_mflash_rsc | ||
| 82 | }; | ||
| 83 | |||
| 84 | platform_device_register(&mflash_dev); | ||
diff --git a/drivers/block/Kconfig b/drivers/block/Kconfig index e7b8aa0cb47c..ddea8e485cc9 100644 --- a/drivers/block/Kconfig +++ b/drivers/block/Kconfig | |||
| @@ -410,6 +410,23 @@ config ATA_OVER_ETH | |||
| 410 | This driver provides Support for ATA over Ethernet block | 410 | This driver provides Support for ATA over Ethernet block |
| 411 | devices like the Coraid EtherDrive (R) Storage Blade. | 411 | devices like the Coraid EtherDrive (R) Storage Blade. |
| 412 | 412 | ||
| 413 | config MG_DISK | ||
| 414 | tristate "mGine mflash, gflash support" | ||
| 415 | depends on ARM && ATA && GPIOLIB | ||
| 416 | help | ||
| 417 | mGine mFlash(gFlash) block device driver | ||
| 418 | |||
| 419 | config MG_DISK_RES | ||
| 420 | int "Size of reserved area before MBR" | ||
| 421 | depends on MG_DISK | ||
| 422 | default 0 | ||
| 423 | help | ||
| 424 | Define size of reserved area that usually used for boot. Unit is KB. | ||
| 425 | All of the block device operation will be taken this value as start | ||
| 426 | offset | ||
| 427 | Examples: | ||
| 428 | 1024 => 1 MB | ||
| 429 | |||
| 413 | config SUNVDC | 430 | config SUNVDC |
| 414 | tristate "Sun Virtual Disk Client support" | 431 | tristate "Sun Virtual Disk Client support" |
| 415 | depends on SUN_LDOMS | 432 | depends on SUN_LDOMS |
diff --git a/drivers/block/Makefile b/drivers/block/Makefile index 3145141cef72..7755a5e2a85e 100644 --- a/drivers/block/Makefile +++ b/drivers/block/Makefile | |||
| @@ -21,6 +21,7 @@ obj-$(CONFIG_BLK_CPQ_CISS_DA) += cciss.o | |||
| 21 | obj-$(CONFIG_BLK_DEV_DAC960) += DAC960.o | 21 | obj-$(CONFIG_BLK_DEV_DAC960) += DAC960.o |
| 22 | obj-$(CONFIG_XILINX_SYSACE) += xsysace.o | 22 | obj-$(CONFIG_XILINX_SYSACE) += xsysace.o |
| 23 | obj-$(CONFIG_CDROM_PKTCDVD) += pktcdvd.o | 23 | obj-$(CONFIG_CDROM_PKTCDVD) += pktcdvd.o |
| 24 | obj-$(CONFIG_MG_DISK) += mg_disk.o | ||
| 24 | obj-$(CONFIG_SUNVDC) += sunvdc.o | 25 | obj-$(CONFIG_SUNVDC) += sunvdc.o |
| 25 | 26 | ||
| 26 | obj-$(CONFIG_BLK_DEV_UMEM) += umem.o | 27 | obj-$(CONFIG_BLK_DEV_UMEM) += umem.o |
diff --git a/drivers/block/mg_disk.c b/drivers/block/mg_disk.c new file mode 100644 index 000000000000..fb39d9aa3cdc --- /dev/null +++ b/drivers/block/mg_disk.c | |||
| @@ -0,0 +1,1005 @@ | |||
| 1 | /* | ||
| 2 | * drivers/block/mg_disk.c | ||
| 3 | * | ||
| 4 | * Support for the mGine m[g]flash IO mode. | ||
| 5 | * Based on legacy hd.c | ||
| 6 | * | ||
| 7 | * (c) 2008 mGine Co.,LTD | ||
| 8 | * (c) 2008 unsik Kim <donari75@gmail.com> | ||
| 9 | * | ||
| 10 | * This program is free software; you can redistribute it and/or modify | ||
| 11 | * it under the terms of the GNU General Public License version 2 as | ||
| 12 | * published by the Free Software Foundation. | ||
| 13 | */ | ||
| 14 | |||
| 15 | #include <linux/kernel.h> | ||
| 16 | #include <linux/module.h> | ||
| 17 | #include <linux/fs.h> | ||
| 18 | #include <linux/blkdev.h> | ||
| 19 | #include <linux/hdreg.h> | ||
| 20 | #include <linux/libata.h> | ||
| 21 | #include <linux/interrupt.h> | ||
| 22 | #include <linux/delay.h> | ||
| 23 | #include <linux/platform_device.h> | ||
| 24 | #include <linux/gpio.h> | ||
| 25 | #include <linux/mg_disk.h> | ||
| 26 | |||
| 27 | #define MG_RES_SEC (CONFIG_MG_DISK_RES << 1) | ||
| 28 | |||
| 29 | static void mg_request(struct request_queue *); | ||
| 30 | |||
| 31 | static void mg_dump_status(const char *msg, unsigned int stat, | ||
| 32 | struct mg_host *host) | ||
| 33 | { | ||
| 34 | char *name = MG_DISK_NAME; | ||
| 35 | struct request *req; | ||
| 36 | |||
| 37 | if (host->breq) { | ||
| 38 | req = elv_next_request(host->breq); | ||
| 39 | if (req) | ||
| 40 | name = req->rq_disk->disk_name; | ||
| 41 | } | ||
| 42 | |||
| 43 | printk(KERN_ERR "%s: %s: status=0x%02x { ", name, msg, stat & 0xff); | ||
| 44 | if (stat & MG_REG_STATUS_BIT_BUSY) | ||
| 45 | printk("Busy "); | ||
| 46 | if (stat & MG_REG_STATUS_BIT_READY) | ||
| 47 | printk("DriveReady "); | ||
| 48 | if (stat & MG_REG_STATUS_BIT_WRITE_FAULT) | ||
| 49 | printk("WriteFault "); | ||
| 50 | if (stat & MG_REG_STATUS_BIT_SEEK_DONE) | ||
| 51 | printk("SeekComplete "); | ||
| 52 | if (stat & MG_REG_STATUS_BIT_DATA_REQ) | ||
| 53 | printk("DataRequest "); | ||
| 54 | if (stat & MG_REG_STATUS_BIT_CORRECTED_ERROR) | ||
| 55 | printk("CorrectedError "); | ||
| 56 | if (stat & MG_REG_STATUS_BIT_ERROR) | ||
| 57 | printk("Error "); | ||
| 58 | printk("}\n"); | ||
| 59 | if ((stat & MG_REG_STATUS_BIT_ERROR) == 0) { | ||
| 60 | host->error = 0; | ||
| 61 | } else { | ||
| 62 | host->error = inb((unsigned long)host->dev_base + MG_REG_ERROR); | ||
| 63 | printk(KERN_ERR "%s: %s: error=0x%02x { ", name, msg, | ||
| 64 | host->error & 0xff); | ||
| 65 | if (host->error & MG_REG_ERR_BBK) | ||
| 66 | printk("BadSector "); | ||
| 67 | if (host->error & MG_REG_ERR_UNC) | ||
| 68 | printk("UncorrectableError "); | ||
| 69 | if (host->error & MG_REG_ERR_IDNF) | ||
| 70 | printk("SectorIdNotFound "); | ||
| 71 | if (host->error & MG_REG_ERR_ABRT) | ||
| 72 | printk("DriveStatusError "); | ||
| 73 | if (host->error & MG_REG_ERR_AMNF) | ||
| 74 | printk("AddrMarkNotFound "); | ||
| 75 | printk("}"); | ||
| 76 | if (host->error & | ||
| 77 | (MG_REG_ERR_BBK | MG_REG_ERR_UNC | | ||
| 78 | MG_REG_ERR_IDNF | MG_REG_ERR_AMNF)) { | ||
| 79 | if (host->breq) { | ||
| 80 | req = elv_next_request(host->breq); | ||
| 81 | if (req) | ||
| 82 | printk(", sector=%ld", req->sector); | ||
| 83 | } | ||
| 84 | |||
| 85 | } | ||
| 86 | printk("\n"); | ||
| 87 | } | ||
| 88 | } | ||
| 89 | |||
| 90 | static unsigned int mg_wait(struct mg_host *host, u32 expect, u32 msec) | ||
| 91 | { | ||
| 92 | u8 status; | ||
| 93 | unsigned long expire, cur_jiffies; | ||
| 94 | struct mg_drv_data *prv_data = host->dev->platform_data; | ||
| 95 | |||
| 96 | host->error = MG_ERR_NONE; | ||
| 97 | expire = jiffies + msecs_to_jiffies(msec); | ||
| 98 | |||
| 99 | status = inb((unsigned long)host->dev_base + MG_REG_STATUS); | ||
| 100 | |||
| 101 | do { | ||
| 102 | cur_jiffies = jiffies; | ||
| 103 | if (status & MG_REG_STATUS_BIT_BUSY) { | ||
| 104 | if (expect == MG_REG_STATUS_BIT_BUSY) | ||
| 105 | break; | ||
| 106 | } else { | ||
| 107 | /* Check the error condition! */ | ||
| 108 | if (status & MG_REG_STATUS_BIT_ERROR) { | ||
| 109 | mg_dump_status("mg_wait", status, host); | ||
| 110 | break; | ||
| 111 | } | ||
| 112 | |||
| 113 | if (expect == MG_STAT_READY) | ||
| 114 | if (MG_READY_OK(status)) | ||
| 115 | break; | ||
| 116 | |||
| 117 | if (expect == MG_REG_STATUS_BIT_DATA_REQ) | ||
| 118 | if (status & MG_REG_STATUS_BIT_DATA_REQ) | ||
| 119 | break; | ||
| 120 | } | ||
| 121 | if (!msec) { | ||
| 122 | mg_dump_status("not ready", status, host); | ||
| 123 | return MG_ERR_INV_STAT; | ||
| 124 | } | ||
| 125 | if (prv_data->use_polling) | ||
| 126 | msleep(1); | ||
| 127 | |||
| 128 | status = inb((unsigned long)host->dev_base + MG_REG_STATUS); | ||
| 129 | } while (time_before(cur_jiffies, expire)); | ||
| 130 | |||
| 131 | if (time_after_eq(cur_jiffies, expire) && msec) | ||
| 132 | host->error = MG_ERR_TIMEOUT; | ||
| 133 | |||
| 134 | return host->error; | ||
| 135 | } | ||
| 136 | |||
| 137 | static unsigned int mg_wait_rstout(u32 rstout, u32 msec) | ||
| 138 | { | ||
| 139 | unsigned long expire; | ||
| 140 | |||
| 141 | expire = jiffies + msecs_to_jiffies(msec); | ||
| 142 | while (time_before(jiffies, expire)) { | ||
| 143 | if (gpio_get_value(rstout) == 1) | ||
| 144 | return MG_ERR_NONE; | ||
| 145 | msleep(10); | ||
| 146 | } | ||
| 147 | |||
| 148 | return MG_ERR_RSTOUT; | ||
| 149 | } | ||
| 150 | |||
| 151 | static void mg_unexpected_intr(struct mg_host *host) | ||
| 152 | { | ||
| 153 | u32 status = inb((unsigned long)host->dev_base + MG_REG_STATUS); | ||
| 154 | |||
| 155 | mg_dump_status("mg_unexpected_intr", status, host); | ||
| 156 | } | ||
| 157 | |||
| 158 | static irqreturn_t mg_irq(int irq, void *dev_id) | ||
| 159 | { | ||
| 160 | struct mg_host *host = dev_id; | ||
| 161 | void (*handler)(struct mg_host *) = host->mg_do_intr; | ||
| 162 | |||
| 163 | host->mg_do_intr = 0; | ||
| 164 | del_timer(&host->timer); | ||
| 165 | if (!handler) | ||
| 166 | handler = mg_unexpected_intr; | ||
| 167 | handler(host); | ||
| 168 | return IRQ_HANDLED; | ||
| 169 | } | ||
| 170 | |||
| 171 | static int mg_get_disk_id(struct mg_host *host) | ||
| 172 | { | ||
| 173 | u32 i; | ||
| 174 | s32 err; | ||
| 175 | const u16 *id = host->id; | ||
| 176 | struct mg_drv_data *prv_data = host->dev->platform_data; | ||
| 177 | char fwrev[ATA_ID_FW_REV_LEN + 1]; | ||
| 178 | char model[ATA_ID_PROD_LEN + 1]; | ||
| 179 | char serial[ATA_ID_SERNO_LEN + 1]; | ||
| 180 | |||
| 181 | if (!prv_data->use_polling) | ||
| 182 | outb(MG_REG_CTRL_INTR_DISABLE, | ||
| 183 | (unsigned long)host->dev_base + | ||
| 184 | MG_REG_DRV_CTRL); | ||
| 185 | |||
| 186 | outb(MG_CMD_ID, (unsigned long)host->dev_base + MG_REG_COMMAND); | ||
| 187 | err = mg_wait(host, MG_REG_STATUS_BIT_DATA_REQ, MG_TMAX_WAIT_RD_DRQ); | ||
| 188 | if (err) | ||
| 189 | return err; | ||
| 190 | |||
| 191 | for (i = 0; i < (MG_SECTOR_SIZE >> 1); i++) | ||
| 192 | host->id[i] = le16_to_cpu(inw((unsigned long)host->dev_base + | ||
| 193 | MG_BUFF_OFFSET + i * 2)); | ||
| 194 | |||
| 195 | outb(MG_CMD_RD_CONF, (unsigned long)host->dev_base + MG_REG_COMMAND); | ||
| 196 | err = mg_wait(host, MG_STAT_READY, MG_TMAX_CONF_TO_CMD); | ||
| 197 | if (err) | ||
| 198 | return err; | ||
| 199 | |||
| 200 | if ((id[ATA_ID_FIELD_VALID] & 1) == 0) | ||
| 201 | return MG_ERR_TRANSLATION; | ||
| 202 | |||
| 203 | host->n_sectors = ata_id_u32(id, ATA_ID_LBA_CAPACITY); | ||
| 204 | host->cyls = id[ATA_ID_CYLS]; | ||
| 205 | host->heads = id[ATA_ID_HEADS]; | ||
| 206 | host->sectors = id[ATA_ID_SECTORS]; | ||
| 207 | |||
| 208 | if (MG_RES_SEC && host->heads && host->sectors) { | ||
| 209 | /* modify cyls, n_sectors */ | ||
| 210 | host->cyls = (host->n_sectors - MG_RES_SEC) / | ||
| 211 | host->heads / host->sectors; | ||
| 212 | host->nres_sectors = host->n_sectors - host->cyls * | ||
| 213 | host->heads * host->sectors; | ||
| 214 | host->n_sectors -= host->nres_sectors; | ||
| 215 | } | ||
| 216 | |||
| 217 | ata_id_c_string(id, fwrev, ATA_ID_FW_REV, sizeof(fwrev)); | ||
| 218 | ata_id_c_string(id, model, ATA_ID_PROD, sizeof(model)); | ||
| 219 | ata_id_c_string(id, serial, ATA_ID_SERNO, sizeof(serial)); | ||
| 220 | printk(KERN_INFO "mg_disk: model: %s\n", model); | ||
| 221 | printk(KERN_INFO "mg_disk: firm: %.8s\n", fwrev); | ||
| 222 | printk(KERN_INFO "mg_disk: serial: %s\n", serial); | ||
| 223 | printk(KERN_INFO "mg_disk: %d + reserved %d sectors\n", | ||
| 224 | host->n_sectors, host->nres_sectors); | ||
| 225 | |||
| 226 | if (!prv_data->use_polling) | ||
| 227 | outb(MG_REG_CTRL_INTR_ENABLE, (unsigned long)host->dev_base + | ||
| 228 | MG_REG_DRV_CTRL); | ||
| 229 | |||
| 230 | return err; | ||
| 231 | } | ||
| 232 | |||
| 233 | |||
| 234 | static int mg_disk_init(struct mg_host *host) | ||
| 235 | { | ||
| 236 | struct mg_drv_data *prv_data = host->dev->platform_data; | ||
| 237 | s32 err; | ||
| 238 | u8 init_status; | ||
| 239 | |||
| 240 | /* hdd rst low */ | ||
| 241 | gpio_set_value(host->rst, 0); | ||
| 242 | err = mg_wait(host, MG_REG_STATUS_BIT_BUSY, MG_TMAX_RST_TO_BUSY); | ||
| 243 | if (err) | ||
| 244 | return err; | ||
| 245 | |||
| 246 | /* hdd rst high */ | ||
| 247 | gpio_set_value(host->rst, 1); | ||
| 248 | err = mg_wait(host, MG_STAT_READY, MG_TMAX_HDRST_TO_RDY); | ||
| 249 | if (err) | ||
| 250 | return err; | ||
| 251 | |||
| 252 | /* soft reset on */ | ||
| 253 | outb(MG_REG_CTRL_RESET | | ||
| 254 | (prv_data->use_polling ? MG_REG_CTRL_INTR_DISABLE : | ||
| 255 | MG_REG_CTRL_INTR_ENABLE), | ||
| 256 | (unsigned long)host->dev_base + MG_REG_DRV_CTRL); | ||
| 257 | err = mg_wait(host, MG_REG_STATUS_BIT_BUSY, MG_TMAX_RST_TO_BUSY); | ||
| 258 | if (err) | ||
| 259 | return err; | ||
| 260 | |||
| 261 | /* soft reset off */ | ||
| 262 | outb(prv_data->use_polling ? MG_REG_CTRL_INTR_DISABLE : | ||
| 263 | MG_REG_CTRL_INTR_ENABLE, | ||
| 264 | (unsigned long)host->dev_base + MG_REG_DRV_CTRL); | ||
| 265 | err = mg_wait(host, MG_STAT_READY, MG_TMAX_SWRST_TO_RDY); | ||
| 266 | if (err) | ||
| 267 | return err; | ||
| 268 | |||
| 269 | init_status = inb((unsigned long)host->dev_base + MG_REG_STATUS) & 0xf; | ||
| 270 | |||
| 271 | if (init_status == 0xf) | ||
| 272 | return MG_ERR_INIT_STAT; | ||
| 273 | |||
| 274 | return err; | ||
| 275 | } | ||
| 276 | |||
| 277 | static void mg_bad_rw_intr(struct mg_host *host) | ||
| 278 | { | ||
| 279 | struct request *req = elv_next_request(host->breq); | ||
| 280 | if (req != NULL) | ||
| 281 | if (++req->errors >= MG_MAX_ERRORS || | ||
| 282 | host->error == MG_ERR_TIMEOUT) | ||
| 283 | end_request(req, 0); | ||
| 284 | } | ||
| 285 | |||
| 286 | static unsigned int mg_out(struct mg_host *host, | ||
| 287 | unsigned int sect_num, | ||
| 288 | unsigned int sect_cnt, | ||
| 289 | unsigned int cmd, | ||
| 290 | void (*intr_addr)(struct mg_host *)) | ||
| 291 | { | ||
| 292 | struct mg_drv_data *prv_data = host->dev->platform_data; | ||
| 293 | |||
| 294 | if (mg_wait(host, MG_STAT_READY, MG_TMAX_CONF_TO_CMD)) | ||
| 295 | return host->error; | ||
| 296 | |||
| 297 | if (!prv_data->use_polling) { | ||
| 298 | host->mg_do_intr = intr_addr; | ||
| 299 | mod_timer(&host->timer, jiffies + 3 * HZ); | ||
| 300 | } | ||
| 301 | if (MG_RES_SEC) | ||
| 302 | sect_num += MG_RES_SEC; | ||
| 303 | outb((u8)sect_cnt, (unsigned long)host->dev_base + MG_REG_SECT_CNT); | ||
| 304 | outb((u8)sect_num, (unsigned long)host->dev_base + MG_REG_SECT_NUM); | ||
| 305 | outb((u8)(sect_num >> 8), (unsigned long)host->dev_base + | ||
| 306 | MG_REG_CYL_LOW); | ||
| 307 | outb((u8)(sect_num >> 16), (unsigned long)host->dev_base + | ||
| 308 | MG_REG_CYL_HIGH); | ||
| 309 | outb((u8)((sect_num >> 24) | MG_REG_HEAD_LBA_MODE), | ||
| 310 | (unsigned long)host->dev_base + MG_REG_DRV_HEAD); | ||
| 311 | outb(cmd, (unsigned long)host->dev_base + MG_REG_COMMAND); | ||
| 312 | return MG_ERR_NONE; | ||
| 313 | } | ||
| 314 | |||
| 315 | static void mg_read(struct request *req) | ||
| 316 | { | ||
| 317 | u32 remains, j; | ||
| 318 | struct mg_host *host = req->rq_disk->private_data; | ||
| 319 | |||
| 320 | remains = req->nr_sectors; | ||
| 321 | |||
| 322 | if (mg_out(host, req->sector, req->nr_sectors, MG_CMD_RD, 0) != | ||
| 323 | MG_ERR_NONE) | ||
| 324 | mg_bad_rw_intr(host); | ||
| 325 | |||
| 326 | MG_DBG("requested %d sects (from %ld), buffer=0x%p\n", | ||
| 327 | remains, req->sector, req->buffer); | ||
| 328 | |||
| 329 | while (remains) { | ||
| 330 | if (mg_wait(host, MG_REG_STATUS_BIT_DATA_REQ, | ||
| 331 | MG_TMAX_WAIT_RD_DRQ) != MG_ERR_NONE) { | ||
| 332 | mg_bad_rw_intr(host); | ||
| 333 | return; | ||
| 334 | } | ||
| 335 | for (j = 0; j < MG_SECTOR_SIZE >> 1; j++) { | ||
| 336 | *(u16 *)req->buffer = | ||
| 337 | inw((unsigned long)host->dev_base + | ||
| 338 | MG_BUFF_OFFSET + (j << 1)); | ||
| 339 | req->buffer += 2; | ||
| 340 | } | ||
| 341 | |||
| 342 | req->sector++; | ||
| 343 | req->errors = 0; | ||
| 344 | remains = --req->nr_sectors; | ||
| 345 | --req->current_nr_sectors; | ||
| 346 | |||
| 347 | if (req->current_nr_sectors <= 0) { | ||
| 348 | MG_DBG("remain : %d sects\n", remains); | ||
| 349 | end_request(req, 1); | ||
| 350 | if (remains > 0) | ||
| 351 | req = elv_next_request(host->breq); | ||
| 352 | } | ||
| 353 | |||
| 354 | outb(MG_CMD_RD_CONF, (unsigned long)host->dev_base + | ||
| 355 | MG_REG_COMMAND); | ||
| 356 | } | ||
| 357 | } | ||
| 358 | |||
| 359 | static void mg_write(struct request *req) | ||
| 360 | { | ||
| 361 | u32 remains, j; | ||
| 362 | struct mg_host *host = req->rq_disk->private_data; | ||
| 363 | |||
| 364 | remains = req->nr_sectors; | ||
| 365 | |||
| 366 | if (mg_out(host, req->sector, req->nr_sectors, MG_CMD_WR, 0) != | ||
| 367 | MG_ERR_NONE) { | ||
| 368 | mg_bad_rw_intr(host); | ||
| 369 | return; | ||
| 370 | } | ||
| 371 | |||
| 372 | |||
| 373 | MG_DBG("requested %d sects (from %ld), buffer=0x%p\n", | ||
| 374 | remains, req->sector, req->buffer); | ||
| 375 | while (remains) { | ||
| 376 | if (mg_wait(host, MG_REG_STATUS_BIT_DATA_REQ, | ||
| 377 | MG_TMAX_WAIT_WR_DRQ) != MG_ERR_NONE) { | ||
| 378 | mg_bad_rw_intr(host); | ||
| 379 | return; | ||
| 380 | } | ||
| 381 | for (j = 0; j < MG_SECTOR_SIZE >> 1; j++) { | ||
| 382 | outw(*(u16 *)req->buffer, | ||
| 383 | (unsigned long)host->dev_base + | ||
| 384 | MG_BUFF_OFFSET + (j << 1)); | ||
| 385 | req->buffer += 2; | ||
| 386 | } | ||
| 387 | req->sector++; | ||
| 388 | remains = --req->nr_sectors; | ||
| 389 | --req->current_nr_sectors; | ||
| 390 | |||
| 391 | if (req->current_nr_sectors <= 0) { | ||
| 392 | MG_DBG("remain : %d sects\n", remains); | ||
| 393 | end_request(req, 1); | ||
| 394 | if (remains > 0) | ||
| 395 | req = elv_next_request(host->breq); | ||
| 396 | } | ||
| 397 | |||
| 398 | outb(MG_CMD_WR_CONF, (unsigned long)host->dev_base + | ||
| 399 | MG_REG_COMMAND); | ||
| 400 | } | ||
| 401 | } | ||
| 402 | |||
| 403 | static void mg_read_intr(struct mg_host *host) | ||
| 404 | { | ||
| 405 | u32 i; | ||
| 406 | struct request *req; | ||
| 407 | |||
| 408 | /* check status */ | ||
| 409 | do { | ||
| 410 | i = inb((unsigned long)host->dev_base + MG_REG_STATUS); | ||
| 411 | if (i & MG_REG_STATUS_BIT_BUSY) | ||
| 412 | break; | ||
| 413 | if (!MG_READY_OK(i)) | ||
| 414 | break; | ||
| 415 | if (i & MG_REG_STATUS_BIT_DATA_REQ) | ||
| 416 | goto ok_to_read; | ||
| 417 | } while (0); | ||
| 418 | mg_dump_status("mg_read_intr", i, host); | ||
| 419 | mg_bad_rw_intr(host); | ||
| 420 | mg_request(host->breq); | ||
| 421 | return; | ||
| 422 | |||
| 423 | ok_to_read: | ||
| 424 | /* get current segment of request */ | ||
| 425 | req = elv_next_request(host->breq); | ||
| 426 | |||
| 427 | /* read 1 sector */ | ||
| 428 | for (i = 0; i < MG_SECTOR_SIZE >> 1; i++) { | ||
| 429 | *(u16 *)req->buffer = | ||
| 430 | inw((unsigned long)host->dev_base + MG_BUFF_OFFSET + | ||
| 431 | (i << 1)); | ||
| 432 | req->buffer += 2; | ||
| 433 | } | ||
| 434 | |||
| 435 | /* manipulate request */ | ||
| 436 | MG_DBG("sector %ld, remaining=%ld, buffer=0x%p\n", | ||
| 437 | req->sector, req->nr_sectors - 1, req->buffer); | ||
| 438 | |||
| 439 | req->sector++; | ||
| 440 | req->errors = 0; | ||
| 441 | i = --req->nr_sectors; | ||
| 442 | --req->current_nr_sectors; | ||
| 443 | |||
| 444 | /* let know if current segment done */ | ||
| 445 | if (req->current_nr_sectors <= 0) | ||
| 446 | end_request(req, 1); | ||
| 447 | |||
| 448 | /* set handler if read remains */ | ||
| 449 | if (i > 0) { | ||
| 450 | host->mg_do_intr = mg_read_intr; | ||
| 451 | mod_timer(&host->timer, jiffies + 3 * HZ); | ||
| 452 | } | ||
| 453 | |||
| 454 | /* send read confirm */ | ||
| 455 | outb(MG_CMD_RD_CONF, (unsigned long)host->dev_base + MG_REG_COMMAND); | ||
| 456 | |||
| 457 | /* goto next request */ | ||
| 458 | if (!i) | ||
| 459 | mg_request(host->breq); | ||
| 460 | } | ||
| 461 | |||
| 462 | static void mg_write_intr(struct mg_host *host) | ||
| 463 | { | ||
| 464 | u32 i, j; | ||
| 465 | u16 *buff; | ||
| 466 | struct request *req; | ||
| 467 | |||
| 468 | /* get current segment of request */ | ||
| 469 | req = elv_next_request(host->breq); | ||
| 470 | |||
| 471 | /* check status */ | ||
| 472 | do { | ||
| 473 | i = inb((unsigned long)host->dev_base + MG_REG_STATUS); | ||
| 474 | if (i & MG_REG_STATUS_BIT_BUSY) | ||
| 475 | break; | ||
| 476 | if (!MG_READY_OK(i)) | ||
| 477 | break; | ||
| 478 | if ((req->nr_sectors <= 1) || (i & MG_REG_STATUS_BIT_DATA_REQ)) | ||
| 479 | goto ok_to_write; | ||
| 480 | } while (0); | ||
| 481 | mg_dump_status("mg_write_intr", i, host); | ||
| 482 | mg_bad_rw_intr(host); | ||
| 483 | mg_request(host->breq); | ||
| 484 | return; | ||
| 485 | |||
| 486 | ok_to_write: | ||
| 487 | /* manipulate request */ | ||
| 488 | req->sector++; | ||
| 489 | i = --req->nr_sectors; | ||
| 490 | --req->current_nr_sectors; | ||
| 491 | req->buffer += MG_SECTOR_SIZE; | ||
| 492 | |||
| 493 | /* let know if current segment or all done */ | ||
| 494 | if (!i || (req->bio && req->current_nr_sectors <= 0)) | ||
| 495 | end_request(req, 1); | ||
| 496 | |||
| 497 | /* write 1 sector and set handler if remains */ | ||
| 498 | if (i > 0) { | ||
| 499 | buff = (u16 *)req->buffer; | ||
| 500 | for (j = 0; j < MG_STORAGE_BUFFER_SIZE >> 1; j++) { | ||
| 501 | outw(*buff, (unsigned long)host->dev_base + | ||
| 502 | MG_BUFF_OFFSET + (j << 1)); | ||
| 503 | buff++; | ||
| 504 | } | ||
| 505 | MG_DBG("sector %ld, remaining=%ld, buffer=0x%p\n", | ||
| 506 | req->sector, req->nr_sectors, req->buffer); | ||
| 507 | host->mg_do_intr = mg_write_intr; | ||
| 508 | mod_timer(&host->timer, jiffies + 3 * HZ); | ||
| 509 | } | ||
| 510 | |||
| 511 | /* send write confirm */ | ||
| 512 | outb(MG_CMD_WR_CONF, (unsigned long)host->dev_base + MG_REG_COMMAND); | ||
| 513 | |||
| 514 | if (!i) | ||
| 515 | mg_request(host->breq); | ||
| 516 | } | ||
| 517 | |||
| 518 | void mg_times_out(unsigned long data) | ||
| 519 | { | ||
| 520 | struct mg_host *host = (struct mg_host *)data; | ||
| 521 | char *name; | ||
| 522 | struct request *req; | ||
| 523 | |||
| 524 | req = elv_next_request(host->breq); | ||
| 525 | if (!req) | ||
| 526 | return; | ||
| 527 | |||
| 528 | host->mg_do_intr = NULL; | ||
| 529 | |||
| 530 | name = req->rq_disk->disk_name; | ||
| 531 | printk(KERN_DEBUG "%s: timeout\n", name); | ||
| 532 | |||
| 533 | host->error = MG_ERR_TIMEOUT; | ||
| 534 | mg_bad_rw_intr(host); | ||
| 535 | |||
| 536 | mg_request(host->breq); | ||
| 537 | } | ||
| 538 | |||
| 539 | static void mg_request_poll(struct request_queue *q) | ||
| 540 | { | ||
| 541 | struct request *req; | ||
| 542 | struct mg_host *host; | ||
| 543 | |||
| 544 | while ((req = elv_next_request(q)) != NULL) { | ||
| 545 | host = req->rq_disk->private_data; | ||
| 546 | if (blk_fs_request(req)) { | ||
| 547 | switch (rq_data_dir(req)) { | ||
| 548 | case READ: | ||
| 549 | mg_read(req); | ||
| 550 | break; | ||
| 551 | case WRITE: | ||
| 552 | mg_write(req); | ||
| 553 | break; | ||
| 554 | default: | ||
| 555 | printk(KERN_WARNING "%s:%d unknown command\n", | ||
| 556 | __func__, __LINE__); | ||
| 557 | end_request(req, 0); | ||
| 558 | break; | ||
| 559 | } | ||
| 560 | } | ||
| 561 | } | ||
| 562 | } | ||
| 563 | |||
| 564 | static unsigned int mg_issue_req(struct request *req, | ||
| 565 | struct mg_host *host, | ||
| 566 | unsigned int sect_num, | ||
| 567 | unsigned int sect_cnt) | ||
| 568 | { | ||
| 569 | u16 *buff; | ||
| 570 | u32 i; | ||
| 571 | |||
| 572 | switch (rq_data_dir(req)) { | ||
| 573 | case READ: | ||
| 574 | if (mg_out(host, sect_num, sect_cnt, MG_CMD_RD, &mg_read_intr) | ||
| 575 | != MG_ERR_NONE) { | ||
| 576 | mg_bad_rw_intr(host); | ||
| 577 | return host->error; | ||
| 578 | } | ||
| 579 | break; | ||
| 580 | case WRITE: | ||
| 581 | /* TODO : handler */ | ||
| 582 | outb(MG_REG_CTRL_INTR_DISABLE, | ||
| 583 | (unsigned long)host->dev_base + | ||
| 584 | MG_REG_DRV_CTRL); | ||
| 585 | if (mg_out(host, sect_num, sect_cnt, MG_CMD_WR, &mg_write_intr) | ||
| 586 | != MG_ERR_NONE) { | ||
| 587 | mg_bad_rw_intr(host); | ||
| 588 | return host->error; | ||
| 589 | } | ||
| 590 | del_timer(&host->timer); | ||
| 591 | mg_wait(host, MG_REG_STATUS_BIT_DATA_REQ, MG_TMAX_WAIT_WR_DRQ); | ||
| 592 | outb(MG_REG_CTRL_INTR_ENABLE, (unsigned long)host->dev_base + | ||
| 593 | MG_REG_DRV_CTRL); | ||
| 594 | if (host->error) { | ||
| 595 | mg_bad_rw_intr(host); | ||
| 596 | return host->error; | ||
| 597 | } | ||
| 598 | buff = (u16 *)req->buffer; | ||
| 599 | for (i = 0; i < MG_SECTOR_SIZE >> 1; i++) { | ||
| 600 | outw(*buff, (unsigned long)host->dev_base + | ||
| 601 | MG_BUFF_OFFSET + (i << 1)); | ||
| 602 | buff++; | ||
| 603 | } | ||
| 604 | mod_timer(&host->timer, jiffies + 3 * HZ); | ||
| 605 | outb(MG_CMD_WR_CONF, (unsigned long)host->dev_base + | ||
| 606 | MG_REG_COMMAND); | ||
| 607 | break; | ||
| 608 | default: | ||
| 609 | printk(KERN_WARNING "%s:%d unknown command\n", | ||
| 610 | __func__, __LINE__); | ||
| 611 | end_request(req, 0); | ||
| 612 | break; | ||
| 613 | } | ||
| 614 | return MG_ERR_NONE; | ||
| 615 | } | ||
| 616 | |||
| 617 | /* This function also called from IRQ context */ | ||
| 618 | static void mg_request(struct request_queue *q) | ||
| 619 | { | ||
| 620 | struct request *req; | ||
| 621 | struct mg_host *host; | ||
| 622 | u32 sect_num, sect_cnt; | ||
| 623 | |||
| 624 | while (1) { | ||
| 625 | req = elv_next_request(q); | ||
| 626 | if (!req) | ||
| 627 | return; | ||
| 628 | |||
| 629 | host = req->rq_disk->private_data; | ||
| 630 | |||
| 631 | /* check unwanted request call */ | ||
| 632 | if (host->mg_do_intr) | ||
| 633 | return; | ||
| 634 | |||
| 635 | del_timer(&host->timer); | ||
| 636 | |||
| 637 | sect_num = req->sector; | ||
| 638 | /* deal whole segments */ | ||
| 639 | sect_cnt = req->nr_sectors; | ||
| 640 | |||
| 641 | /* sanity check */ | ||
| 642 | if (sect_num >= get_capacity(req->rq_disk) || | ||
| 643 | ((sect_num + sect_cnt) > | ||
| 644 | get_capacity(req->rq_disk))) { | ||
| 645 | printk(KERN_WARNING | ||
| 646 | "%s: bad access: sector=%d, count=%d\n", | ||
| 647 | req->rq_disk->disk_name, | ||
| 648 | sect_num, sect_cnt); | ||
| 649 | end_request(req, 0); | ||
| 650 | continue; | ||
| 651 | } | ||
| 652 | |||
| 653 | if (!blk_fs_request(req)) | ||
| 654 | return; | ||
| 655 | |||
| 656 | if (!mg_issue_req(req, host, sect_num, sect_cnt)) | ||
| 657 | return; | ||
| 658 | } | ||
| 659 | } | ||
| 660 | |||
| 661 | static int mg_getgeo(struct block_device *bdev, struct hd_geometry *geo) | ||
| 662 | { | ||
| 663 | struct mg_host *host = bdev->bd_disk->private_data; | ||
| 664 | |||
| 665 | geo->cylinders = (unsigned short)host->cyls; | ||
| 666 | geo->heads = (unsigned char)host->heads; | ||
| 667 | geo->sectors = (unsigned char)host->sectors; | ||
| 668 | return 0; | ||
| 669 | } | ||
| 670 | |||
| 671 | static struct block_device_operations mg_disk_ops = { | ||
| 672 | .getgeo = mg_getgeo | ||
| 673 | }; | ||
| 674 | |||
| 675 | static int mg_suspend(struct platform_device *plat_dev, pm_message_t state) | ||
| 676 | { | ||
| 677 | struct mg_drv_data *prv_data = plat_dev->dev.platform_data; | ||
| 678 | struct mg_host *host = prv_data->host; | ||
| 679 | |||
| 680 | if (mg_wait(host, MG_STAT_READY, MG_TMAX_CONF_TO_CMD)) | ||
| 681 | return -EIO; | ||
| 682 | |||
| 683 | if (!prv_data->use_polling) | ||
| 684 | outb(MG_REG_CTRL_INTR_DISABLE, | ||
| 685 | (unsigned long)host->dev_base + | ||
| 686 | MG_REG_DRV_CTRL); | ||
| 687 | |||
| 688 | outb(MG_CMD_SLEEP, (unsigned long)host->dev_base + MG_REG_COMMAND); | ||
| 689 | /* wait until mflash deep sleep */ | ||
| 690 | msleep(1); | ||
| 691 | |||
| 692 | if (mg_wait(host, MG_STAT_READY, MG_TMAX_CONF_TO_CMD)) { | ||
| 693 | if (!prv_data->use_polling) | ||
| 694 | outb(MG_REG_CTRL_INTR_ENABLE, | ||
| 695 | (unsigned long)host->dev_base + | ||
| 696 | MG_REG_DRV_CTRL); | ||
| 697 | return -EIO; | ||
| 698 | } | ||
| 699 | |||
| 700 | return 0; | ||
| 701 | } | ||
| 702 | |||
| 703 | static int mg_resume(struct platform_device *plat_dev) | ||
| 704 | { | ||
| 705 | struct mg_drv_data *prv_data = plat_dev->dev.platform_data; | ||
| 706 | struct mg_host *host = prv_data->host; | ||
| 707 | |||
| 708 | if (mg_wait(host, MG_STAT_READY, MG_TMAX_CONF_TO_CMD)) | ||
| 709 | return -EIO; | ||
| 710 | |||
| 711 | outb(MG_CMD_WAKEUP, (unsigned long)host->dev_base + MG_REG_COMMAND); | ||
| 712 | /* wait until mflash wakeup */ | ||
| 713 | msleep(1); | ||
| 714 | |||
| 715 | if (mg_wait(host, MG_STAT_READY, MG_TMAX_CONF_TO_CMD)) | ||
| 716 | return -EIO; | ||
| 717 | |||
| 718 | if (!prv_data->use_polling) | ||
| 719 | outb(MG_REG_CTRL_INTR_ENABLE, (unsigned long)host->dev_base + | ||
| 720 | MG_REG_DRV_CTRL); | ||
| 721 | |||
| 722 | return 0; | ||
| 723 | } | ||
| 724 | |||
| 725 | static int mg_probe(struct platform_device *plat_dev) | ||
| 726 | { | ||
| 727 | struct mg_host *host; | ||
| 728 | struct resource *rsc; | ||
| 729 | struct mg_drv_data *prv_data = plat_dev->dev.platform_data; | ||
| 730 | int err = 0; | ||
| 731 | |||
| 732 | if (!prv_data) { | ||
| 733 | printk(KERN_ERR "%s:%d fail (no driver_data)\n", | ||
| 734 | __func__, __LINE__); | ||
| 735 | err = -EINVAL; | ||
| 736 | goto probe_err; | ||
| 737 | } | ||
| 738 | |||
| 739 | /* alloc mg_host */ | ||
| 740 | host = kzalloc(sizeof(struct mg_host), GFP_KERNEL); | ||
| 741 | if (!host) { | ||
| 742 | printk(KERN_ERR "%s:%d fail (no memory for mg_host)\n", | ||
| 743 | __func__, __LINE__); | ||
| 744 | err = -ENOMEM; | ||
| 745 | goto probe_err; | ||
| 746 | } | ||
| 747 | host->major = MG_DISK_MAJ; | ||
| 748 | |||
| 749 | /* link each other */ | ||
| 750 | prv_data->host = host; | ||
| 751 | host->dev = &plat_dev->dev; | ||
| 752 | |||
| 753 | /* io remap */ | ||
| 754 | rsc = platform_get_resource(plat_dev, IORESOURCE_MEM, 0); | ||
| 755 | if (!rsc) { | ||
| 756 | printk(KERN_ERR "%s:%d platform_get_resource fail\n", | ||
| 757 | __func__, __LINE__); | ||
| 758 | err = -EINVAL; | ||
| 759 | goto probe_err_2; | ||
| 760 | } | ||
| 761 | host->dev_base = ioremap(rsc->start , rsc->end + 1); | ||
| 762 | if (!host->dev_base) { | ||
| 763 | printk(KERN_ERR "%s:%d ioremap fail\n", | ||
| 764 | __func__, __LINE__); | ||
| 765 | err = -EIO; | ||
| 766 | goto probe_err_2; | ||
| 767 | } | ||
| 768 | MG_DBG("dev_base = 0x%x\n", (u32)host->dev_base); | ||
| 769 | |||
| 770 | /* get reset pin */ | ||
| 771 | rsc = platform_get_resource_byname(plat_dev, IORESOURCE_IO, | ||
| 772 | MG_RST_PIN); | ||
| 773 | if (!rsc) { | ||
| 774 | printk(KERN_ERR "%s:%d get reset pin fail\n", | ||
| 775 | __func__, __LINE__); | ||
| 776 | err = -EIO; | ||
| 777 | goto probe_err_3; | ||
| 778 | } | ||
| 779 | host->rst = rsc->start; | ||
| 780 | |||
| 781 | /* init rst pin */ | ||
| 782 | err = gpio_request(host->rst, MG_RST_PIN); | ||
| 783 | if (err) | ||
| 784 | goto probe_err_3; | ||
| 785 | gpio_direction_output(host->rst, 1); | ||
| 786 | |||
| 787 | /* reset out pin */ | ||
| 788 | if (!(prv_data->dev_attr & MG_DEV_MASK)) | ||
| 789 | goto probe_err_3a; | ||
| 790 | |||
| 791 | if (prv_data->dev_attr != MG_BOOT_DEV) { | ||
| 792 | rsc = platform_get_resource_byname(plat_dev, IORESOURCE_IO, | ||
| 793 | MG_RSTOUT_PIN); | ||
| 794 | if (!rsc) { | ||
| 795 | printk(KERN_ERR "%s:%d get reset-out pin fail\n", | ||
| 796 | __func__, __LINE__); | ||
| 797 | err = -EIO; | ||
| 798 | goto probe_err_3a; | ||
| 799 | } | ||
| 800 | host->rstout = rsc->start; | ||
| 801 | err = gpio_request(host->rstout, MG_RSTOUT_PIN); | ||
| 802 | if (err) | ||
| 803 | goto probe_err_3a; | ||
| 804 | gpio_direction_input(host->rstout); | ||
| 805 | } | ||
| 806 | |||
| 807 | /* disk reset */ | ||
| 808 | if (prv_data->dev_attr == MG_STORAGE_DEV) { | ||
| 809 | /* If POR seq. not yet finised, wait */ | ||
| 810 | err = mg_wait_rstout(host->rstout, MG_TMAX_RSTOUT); | ||
| 811 | if (err) | ||
| 812 | goto probe_err_3b; | ||
| 813 | err = mg_disk_init(host); | ||
| 814 | if (err) { | ||
| 815 | printk(KERN_ERR "%s:%d fail (err code : %d)\n", | ||
| 816 | __func__, __LINE__, err); | ||
| 817 | err = -EIO; | ||
| 818 | goto probe_err_3b; | ||
| 819 | } | ||
| 820 | } | ||
| 821 | |||
| 822 | /* get irq resource */ | ||
| 823 | if (!prv_data->use_polling) { | ||
| 824 | host->irq = platform_get_irq(plat_dev, 0); | ||
| 825 | if (host->irq == -ENXIO) { | ||
| 826 | err = host->irq; | ||
| 827 | goto probe_err_3b; | ||
| 828 | } | ||
| 829 | err = request_irq(host->irq, mg_irq, | ||
| 830 | IRQF_DISABLED | IRQF_TRIGGER_RISING, | ||
| 831 | MG_DEV_NAME, host); | ||
| 832 | if (err) { | ||
| 833 | printk(KERN_ERR "%s:%d fail (request_irq err=%d)\n", | ||
| 834 | __func__, __LINE__, err); | ||
| 835 | goto probe_err_3b; | ||
| 836 | } | ||
| 837 | |||
| 838 | } | ||
| 839 | |||
| 840 | /* get disk id */ | ||
| 841 | err = mg_get_disk_id(host); | ||
| 842 | if (err) { | ||
| 843 | printk(KERN_ERR "%s:%d fail (err code : %d)\n", | ||
| 844 | __func__, __LINE__, err); | ||
| 845 | err = -EIO; | ||
| 846 | goto probe_err_4; | ||
| 847 | } | ||
| 848 | |||
| 849 | err = register_blkdev(host->major, MG_DISK_NAME); | ||
| 850 | if (err < 0) { | ||
| 851 | printk(KERN_ERR "%s:%d register_blkdev fail (err code : %d)\n", | ||
| 852 | __func__, __LINE__, err); | ||
| 853 | goto probe_err_4; | ||
| 854 | } | ||
| 855 | if (!host->major) | ||
| 856 | host->major = err; | ||
| 857 | |||
| 858 | spin_lock_init(&host->lock); | ||
| 859 | |||
| 860 | if (prv_data->use_polling) | ||
| 861 | host->breq = blk_init_queue(mg_request_poll, &host->lock); | ||
| 862 | else | ||
| 863 | host->breq = blk_init_queue(mg_request, &host->lock); | ||
| 864 | |||
| 865 | if (!host->breq) { | ||
| 866 | err = -ENOMEM; | ||
| 867 | printk(KERN_ERR "%s:%d (blk_init_queue) fail\n", | ||
| 868 | __func__, __LINE__); | ||
| 869 | goto probe_err_5; | ||
| 870 | } | ||
| 871 | |||
| 872 | /* mflash is random device, thanx for the noop */ | ||
| 873 | elevator_exit(host->breq->elevator); | ||
| 874 | err = elevator_init(host->breq, "noop"); | ||
| 875 | if (err) { | ||
| 876 | printk(KERN_ERR "%s:%d (elevator_init) fail\n", | ||
| 877 | __func__, __LINE__); | ||
| 878 | goto probe_err_6; | ||
| 879 | } | ||
| 880 | blk_queue_max_sectors(host->breq, MG_MAX_SECTS); | ||
| 881 | blk_queue_hardsect_size(host->breq, MG_SECTOR_SIZE); | ||
| 882 | |||
| 883 | init_timer(&host->timer); | ||
| 884 | host->timer.function = mg_times_out; | ||
| 885 | host->timer.data = (unsigned long)host; | ||
| 886 | |||
| 887 | host->gd = alloc_disk(MG_DISK_MAX_PART); | ||
| 888 | if (!host->gd) { | ||
| 889 | printk(KERN_ERR "%s:%d (alloc_disk) fail\n", | ||
| 890 | __func__, __LINE__); | ||
| 891 | err = -ENOMEM; | ||
| 892 | goto probe_err_7; | ||
| 893 | } | ||
| 894 | host->gd->major = host->major; | ||
| 895 | host->gd->first_minor = 0; | ||
| 896 | host->gd->fops = &mg_disk_ops; | ||
| 897 | host->gd->queue = host->breq; | ||
| 898 | host->gd->private_data = host; | ||
| 899 | sprintf(host->gd->disk_name, MG_DISK_NAME"a"); | ||
| 900 | |||
| 901 | set_capacity(host->gd, host->n_sectors); | ||
| 902 | |||
| 903 | add_disk(host->gd); | ||
| 904 | |||
| 905 | return err; | ||
| 906 | |||
| 907 | probe_err_7: | ||
| 908 | del_timer_sync(&host->timer); | ||
| 909 | probe_err_6: | ||
| 910 | blk_cleanup_queue(host->breq); | ||
| 911 | probe_err_5: | ||
| 912 | unregister_blkdev(MG_DISK_MAJ, MG_DISK_NAME); | ||
| 913 | probe_err_4: | ||
| 914 | if (!prv_data->use_polling) | ||
| 915 | free_irq(host->irq, host); | ||
| 916 | probe_err_3b: | ||
| 917 | gpio_free(host->rstout); | ||
| 918 | probe_err_3a: | ||
| 919 | gpio_free(host->rst); | ||
| 920 | probe_err_3: | ||
| 921 | iounmap(host->dev_base); | ||
| 922 | probe_err_2: | ||
| 923 | kfree(host); | ||
| 924 | probe_err: | ||
| 925 | return err; | ||
| 926 | } | ||
| 927 | |||
| 928 | static int mg_remove(struct platform_device *plat_dev) | ||
| 929 | { | ||
| 930 | struct mg_drv_data *prv_data = plat_dev->dev.platform_data; | ||
| 931 | struct mg_host *host = prv_data->host; | ||
| 932 | int err = 0; | ||
| 933 | |||
| 934 | /* delete timer */ | ||
| 935 | del_timer_sync(&host->timer); | ||
| 936 | |||
| 937 | /* remove disk */ | ||
| 938 | if (host->gd) { | ||
| 939 | del_gendisk(host->gd); | ||
| 940 | put_disk(host->gd); | ||
| 941 | } | ||
| 942 | /* remove queue */ | ||
| 943 | if (host->breq) | ||
| 944 | blk_cleanup_queue(host->breq); | ||
| 945 | |||
| 946 | /* unregister blk device */ | ||
| 947 | unregister_blkdev(host->major, MG_DISK_NAME); | ||
| 948 | |||
| 949 | /* free irq */ | ||
| 950 | if (!prv_data->use_polling) | ||
| 951 | free_irq(host->irq, host); | ||
| 952 | |||
| 953 | /* free reset-out pin */ | ||
| 954 | if (prv_data->dev_attr != MG_BOOT_DEV) | ||
| 955 | gpio_free(host->rstout); | ||
| 956 | |||
| 957 | /* free rst pin */ | ||
| 958 | if (host->rst) | ||
| 959 | gpio_free(host->rst); | ||
| 960 | |||
| 961 | /* unmap io */ | ||
| 962 | if (host->dev_base) | ||
| 963 | iounmap(host->dev_base); | ||
| 964 | |||
| 965 | /* free mg_host */ | ||
| 966 | kfree(host); | ||
| 967 | |||
| 968 | return err; | ||
| 969 | } | ||
| 970 | |||
| 971 | static struct platform_driver mg_disk_driver = { | ||
| 972 | .probe = mg_probe, | ||
| 973 | .remove = mg_remove, | ||
| 974 | .suspend = mg_suspend, | ||
| 975 | .resume = mg_resume, | ||
| 976 | .driver = { | ||
| 977 | .name = MG_DEV_NAME, | ||
| 978 | .owner = THIS_MODULE, | ||
| 979 | } | ||
| 980 | }; | ||
| 981 | |||
| 982 | /**************************************************************************** | ||
| 983 | * | ||
| 984 | * Module stuff | ||
| 985 | * | ||
| 986 | ****************************************************************************/ | ||
| 987 | |||
| 988 | static int __init mg_init(void) | ||
| 989 | { | ||
| 990 | printk(KERN_INFO "mGine mflash driver, (c) 2008 mGine Co.\n"); | ||
| 991 | return platform_driver_register(&mg_disk_driver); | ||
| 992 | } | ||
| 993 | |||
| 994 | static void __exit mg_exit(void) | ||
| 995 | { | ||
| 996 | printk(KERN_INFO "mflash driver : bye bye\n"); | ||
| 997 | platform_driver_unregister(&mg_disk_driver); | ||
| 998 | } | ||
| 999 | |||
| 1000 | module_init(mg_init); | ||
| 1001 | module_exit(mg_exit); | ||
| 1002 | |||
| 1003 | MODULE_LICENSE("GPL"); | ||
| 1004 | MODULE_AUTHOR("unsik Kim <donari75@gmail.com>"); | ||
| 1005 | MODULE_DESCRIPTION("mGine m[g]flash device driver"); | ||
diff --git a/include/linux/mg_disk.h b/include/linux/mg_disk.h new file mode 100644 index 000000000000..1f76b1ebf627 --- /dev/null +++ b/include/linux/mg_disk.h | |||
| @@ -0,0 +1,206 @@ | |||
| 1 | /* | ||
| 2 | * include/linux/mg_disk.c | ||
| 3 | * | ||
| 4 | * Support for the mGine m[g]flash IO mode. | ||
| 5 | * Based on legacy hd.c | ||
| 6 | * | ||
| 7 | * (c) 2008 mGine Co.,LTD | ||
| 8 | * (c) 2008 unsik Kim <donari75@gmail.com> | ||
| 9 | * | ||
| 10 | * This program is free software; you can redistribute it and/or modify | ||
| 11 | * it under the terms of the GNU General Public License version 2 as | ||
| 12 | * published by the Free Software Foundation. | ||
| 13 | */ | ||
| 14 | |||
| 15 | #ifndef __MG_DISK_H__ | ||
| 16 | #define __MG_DISK_H__ | ||
| 17 | |||
| 18 | #include <linux/blkdev.h> | ||
| 19 | #include <linux/ata.h> | ||
| 20 | |||
| 21 | /* name for block device */ | ||
| 22 | #define MG_DISK_NAME "mgd" | ||
| 23 | /* name for platform device */ | ||
| 24 | #define MG_DEV_NAME "mg_disk" | ||
| 25 | |||
| 26 | #define MG_DISK_MAJ 0 | ||
| 27 | #define MG_DISK_MAX_PART 16 | ||
| 28 | #define MG_SECTOR_SIZE 512 | ||
| 29 | #define MG_MAX_SECTS 256 | ||
| 30 | |||
| 31 | /* Register offsets */ | ||
| 32 | #define MG_BUFF_OFFSET 0x8000 | ||
| 33 | #define MG_STORAGE_BUFFER_SIZE 0x200 | ||
| 34 | #define MG_REG_OFFSET 0xC000 | ||
| 35 | #define MG_REG_FEATURE (MG_REG_OFFSET + 2) /* write case */ | ||
| 36 | #define MG_REG_ERROR (MG_REG_OFFSET + 2) /* read case */ | ||
| 37 | #define MG_REG_SECT_CNT (MG_REG_OFFSET + 4) | ||
| 38 | #define MG_REG_SECT_NUM (MG_REG_OFFSET + 6) | ||
| 39 | #define MG_REG_CYL_LOW (MG_REG_OFFSET + 8) | ||
| 40 | #define MG_REG_CYL_HIGH (MG_REG_OFFSET + 0xA) | ||
| 41 | #define MG_REG_DRV_HEAD (MG_REG_OFFSET + 0xC) | ||
| 42 | #define MG_REG_COMMAND (MG_REG_OFFSET + 0xE) /* write case */ | ||
| 43 | #define MG_REG_STATUS (MG_REG_OFFSET + 0xE) /* read case */ | ||
| 44 | #define MG_REG_DRV_CTRL (MG_REG_OFFSET + 0x10) | ||
| 45 | #define MG_REG_BURST_CTRL (MG_REG_OFFSET + 0x12) | ||
| 46 | |||
| 47 | /* "Drive Select/Head Register" bit values */ | ||
| 48 | #define MG_REG_HEAD_MUST_BE_ON 0xA0 /* These 2 bits are always on */ | ||
| 49 | #define MG_REG_HEAD_DRIVE_MASTER (0x00 | MG_REG_HEAD_MUST_BE_ON) | ||
| 50 | #define MG_REG_HEAD_DRIVE_SLAVE (0x10 | MG_REG_HEAD_MUST_BE_ON) | ||
| 51 | #define MG_REG_HEAD_LBA_MODE (0x40 | MG_REG_HEAD_MUST_BE_ON) | ||
| 52 | |||
| 53 | |||
| 54 | /* "Device Control Register" bit values */ | ||
| 55 | #define MG_REG_CTRL_INTR_ENABLE 0x0 | ||
| 56 | #define MG_REG_CTRL_INTR_DISABLE (0x1<<1) | ||
| 57 | #define MG_REG_CTRL_RESET (0x1<<2) | ||
| 58 | #define MG_REG_CTRL_INTR_POLA_ACTIVE_HIGH 0x0 | ||
| 59 | #define MG_REG_CTRL_INTR_POLA_ACTIVE_LOW (0x1<<4) | ||
| 60 | #define MG_REG_CTRL_DPD_POLA_ACTIVE_LOW 0x0 | ||
| 61 | #define MG_REG_CTRL_DPD_POLA_ACTIVE_HIGH (0x1<<5) | ||
| 62 | #define MG_REG_CTRL_DPD_DISABLE 0x0 | ||
| 63 | #define MG_REG_CTRL_DPD_ENABLE (0x1<<6) | ||
| 64 | |||
| 65 | /* Status register bit */ | ||
| 66 | /* error bit in status register */ | ||
| 67 | #define MG_REG_STATUS_BIT_ERROR 0x01 | ||
| 68 | /* corrected error in status register */ | ||
| 69 | #define MG_REG_STATUS_BIT_CORRECTED_ERROR 0x04 | ||
| 70 | /* data request bit in status register */ | ||
| 71 | #define MG_REG_STATUS_BIT_DATA_REQ 0x08 | ||
| 72 | /* DSC - Drive Seek Complete */ | ||
| 73 | #define MG_REG_STATUS_BIT_SEEK_DONE 0x10 | ||
| 74 | /* DWF - Drive Write Fault */ | ||
| 75 | #define MG_REG_STATUS_BIT_WRITE_FAULT 0x20 | ||
| 76 | #define MG_REG_STATUS_BIT_READY 0x40 | ||
| 77 | #define MG_REG_STATUS_BIT_BUSY 0x80 | ||
| 78 | |||
| 79 | /* handy status */ | ||
| 80 | #define MG_STAT_READY (MG_REG_STATUS_BIT_READY | MG_REG_STATUS_BIT_SEEK_DONE) | ||
| 81 | #define MG_READY_OK(s) (((s) & (MG_STAT_READY | \ | ||
| 82 | (MG_REG_STATUS_BIT_BUSY | \ | ||
| 83 | MG_REG_STATUS_BIT_WRITE_FAULT | \ | ||
| 84 | MG_REG_STATUS_BIT_ERROR))) == MG_STAT_READY) | ||
| 85 | |||
| 86 | /* Error register */ | ||
| 87 | #define MG_REG_ERR_AMNF 0x01 | ||
| 88 | #define MG_REG_ERR_ABRT 0x04 | ||
| 89 | #define MG_REG_ERR_IDNF 0x10 | ||
| 90 | #define MG_REG_ERR_UNC 0x40 | ||
| 91 | #define MG_REG_ERR_BBK 0x80 | ||
| 92 | |||
| 93 | /* error code for others */ | ||
| 94 | #define MG_ERR_NONE 0 | ||
| 95 | #define MG_ERR_TIMEOUT 0x100 | ||
| 96 | #define MG_ERR_INIT_STAT 0x101 | ||
| 97 | #define MG_ERR_TRANSLATION 0x102 | ||
| 98 | #define MG_ERR_CTRL_RST 0x103 | ||
| 99 | #define MG_ERR_INV_STAT 0x104 | ||
| 100 | #define MG_ERR_RSTOUT 0x105 | ||
| 101 | |||
| 102 | #define MG_MAX_ERRORS 6 /* Max read/write errors */ | ||
| 103 | |||
| 104 | /* command */ | ||
| 105 | #define MG_CMD_RD 0x20 | ||
| 106 | #define MG_CMD_WR 0x30 | ||
| 107 | #define MG_CMD_SLEEP 0x99 | ||
| 108 | #define MG_CMD_WAKEUP 0xC3 | ||
| 109 | #define MG_CMD_ID 0xEC | ||
| 110 | #define MG_CMD_WR_CONF 0x3C | ||
| 111 | #define MG_CMD_RD_CONF 0x40 | ||
| 112 | |||
| 113 | /* operation mode */ | ||
| 114 | #define MG_OP_CASCADE (1 << 0) | ||
| 115 | #define MG_OP_CASCADE_SYNC_RD (1 << 1) | ||
| 116 | #define MG_OP_CASCADE_SYNC_WR (1 << 2) | ||
| 117 | #define MG_OP_INTERLEAVE (1 << 3) | ||
| 118 | |||
| 119 | /* synchronous */ | ||
| 120 | #define MG_BURST_LAT_4 (3 << 4) | ||
| 121 | #define MG_BURST_LAT_5 (4 << 4) | ||
| 122 | #define MG_BURST_LAT_6 (5 << 4) | ||
| 123 | #define MG_BURST_LAT_7 (6 << 4) | ||
| 124 | #define MG_BURST_LAT_8 (7 << 4) | ||
| 125 | #define MG_BURST_LEN_4 (1 << 1) | ||
| 126 | #define MG_BURST_LEN_8 (2 << 1) | ||
| 127 | #define MG_BURST_LEN_16 (3 << 1) | ||
| 128 | #define MG_BURST_LEN_32 (4 << 1) | ||
| 129 | #define MG_BURST_LEN_CONT (0 << 1) | ||
| 130 | |||
| 131 | /* timeout value (unit: ms) */ | ||
| 132 | #define MG_TMAX_CONF_TO_CMD 1 | ||
| 133 | #define MG_TMAX_WAIT_RD_DRQ 10 | ||
| 134 | #define MG_TMAX_WAIT_WR_DRQ 500 | ||
| 135 | #define MG_TMAX_RST_TO_BUSY 10 | ||
| 136 | #define MG_TMAX_HDRST_TO_RDY 500 | ||
| 137 | #define MG_TMAX_SWRST_TO_RDY 500 | ||
| 138 | #define MG_TMAX_RSTOUT 3000 | ||
| 139 | |||
| 140 | /* device attribution */ | ||
| 141 | /* use mflash as boot device */ | ||
| 142 | #define MG_BOOT_DEV (1 << 0) | ||
| 143 | /* use mflash as storage device */ | ||
| 144 | #define MG_STORAGE_DEV (1 << 1) | ||
| 145 | /* same as MG_STORAGE_DEV, but bootloader already done reset sequence */ | ||
| 146 | #define MG_STORAGE_DEV_SKIP_RST (1 << 2) | ||
| 147 | |||
| 148 | #define MG_DEV_MASK (MG_BOOT_DEV | MG_STORAGE_DEV | MG_STORAGE_DEV_SKIP_RST) | ||
| 149 | |||
| 150 | /* names of GPIO resource */ | ||
| 151 | #define MG_RST_PIN "mg_rst" | ||
| 152 | /* except MG_BOOT_DEV, reset-out pin should be assigned */ | ||
| 153 | #define MG_RSTOUT_PIN "mg_rstout" | ||
| 154 | |||
| 155 | /* private driver data */ | ||
| 156 | struct mg_drv_data { | ||
| 157 | /* disk resource */ | ||
| 158 | u32 use_polling; | ||
| 159 | |||
| 160 | /* device attribution */ | ||
| 161 | u32 dev_attr; | ||
| 162 | |||
| 163 | /* internally used */ | ||
| 164 | struct mg_host *host; | ||
| 165 | }; | ||
| 166 | |||
| 167 | /* main structure for mflash driver */ | ||
| 168 | struct mg_host { | ||
| 169 | struct device *dev; | ||
| 170 | |||
| 171 | struct request_queue *breq; | ||
| 172 | spinlock_t lock; | ||
| 173 | struct gendisk *gd; | ||
| 174 | |||
| 175 | struct timer_list timer; | ||
| 176 | void (*mg_do_intr) (struct mg_host *); | ||
| 177 | |||
| 178 | u16 id[ATA_ID_WORDS]; | ||
| 179 | |||
| 180 | u16 cyls; | ||
| 181 | u16 heads; | ||
| 182 | u16 sectors; | ||
| 183 | u32 n_sectors; | ||
| 184 | u32 nres_sectors; | ||
| 185 | |||
| 186 | void __iomem *dev_base; | ||
| 187 | unsigned int irq; | ||
| 188 | unsigned int rst; | ||
| 189 | unsigned int rstout; | ||
| 190 | |||
| 191 | u32 major; | ||
| 192 | u32 error; | ||
| 193 | }; | ||
| 194 | |||
| 195 | /* | ||
| 196 | * Debugging macro and defines | ||
| 197 | */ | ||
| 198 | #undef DO_MG_DEBUG | ||
| 199 | #ifdef DO_MG_DEBUG | ||
| 200 | # define MG_DBG(fmt, args...) \ | ||
| 201 | printk(KERN_DEBUG "%s:%d "fmt, __func__, __LINE__, ##args) | ||
| 202 | #else /* CONFIG_MG_DEBUG */ | ||
| 203 | # define MG_DBG(fmt, args...) do { } while (0) | ||
| 204 | #endif /* CONFIG_MG_DEBUG */ | ||
| 205 | |||
| 206 | #endif | ||
