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 | ||