pata-rb532-cf: replace rb532_pata_finish_io()
[linux-2.6.git] / drivers / ata / pata_rb532_cf.c
1 /*
2  *  A low-level PATA driver to handle a Compact Flash connected on the
3  *  Mikrotik's RouterBoard 532 board.
4  *
5  *  Copyright (C) 2007 Gabor Juhos <juhosg at openwrt.org>
6  *  Copyright (C) 2008 Florian Fainelli <florian@openwrt.org>
7  *
8  *  This file was based on: drivers/ata/pata_ixp4xx_cf.c
9  *      Copyright (C) 2006-07 Tower Technologies
10  *      Author: Alessandro Zummo <a.zummo@towertech.it>
11  *
12  *  Also was based on the driver for Linux 2.4.xx published by Mikrotik for
13  *  their RouterBoard 1xx and 5xx series devices. The original Mikrotik code
14  *  seems not to have a license.
15  *
16  *  This program is free software; you can redistribute it and/or modify
17  *  it under the terms of the GNU General Public License version 2 as
18  *  published by the Free Software Foundation.
19  *
20  */
21
22 #include <linux/kernel.h>
23 #include <linux/module.h>
24 #include <linux/platform_device.h>
25
26 #include <linux/io.h>
27 #include <linux/interrupt.h>
28 #include <linux/irq.h>
29
30 #include <linux/libata.h>
31 #include <scsi/scsi_host.h>
32
33 #include <asm/gpio.h>
34
35 #define DRV_NAME        "pata-rb532-cf"
36 #define DRV_VERSION     "0.1.0"
37 #define DRV_DESC        "PATA driver for RouterBOARD 532 Compact Flash"
38
39 #define RB500_CF_MAXPORTS       1
40 #define RB500_CF_IO_DELAY       400
41
42 #define RB500_CF_REG_BASE       0x0800
43 #define RB500_CF_REG_ERR        0x080D
44 #define RB500_CF_REG_CTRL       0x080E
45 /* 32bit buffered data register offset */
46 #define RB500_CF_REG_DBUF32     0x0C00
47
48 struct rb532_cf_info {
49         void __iomem    *iobase;
50         unsigned int    gpio_line;
51         int             frozen;
52         unsigned int    irq;
53 };
54
55 /* ------------------------------------------------------------------------ */
56
57 static void rb532_pata_exec_command(struct ata_port *ap,
58                                 const struct ata_taskfile *tf)
59 {
60         writeb(tf->command, ap->ioaddr.command_addr);
61         ata_sff_pause(ap);
62 }
63
64 static unsigned int rb532_pata_data_xfer(struct ata_device *adev, unsigned char *buf,
65                                 unsigned int buflen, int write_data)
66 {
67         struct ata_port *ap = adev->link->ap;
68         void __iomem *ioaddr = ap->ioaddr.data_addr;
69         int retlen = buflen;
70
71         if (write_data) {
72                 for (; buflen > 0; buflen--, buf++)
73                         writeb(*buf, ioaddr);
74         } else {
75                 for (; buflen > 0; buflen--, buf++)
76                         *buf = readb(ioaddr);
77         }
78
79         ata_sff_pause(ap);
80         return retlen;
81 }
82
83 static void rb532_pata_freeze(struct ata_port *ap)
84 {
85         struct rb532_cf_info *info = ap->host->private_data;
86
87         info->frozen = 1;
88 }
89
90 static void rb532_pata_thaw(struct ata_port *ap)
91 {
92         struct rb532_cf_info *info = ap->host->private_data;
93
94         info->frozen = 0;
95 }
96
97 static irqreturn_t rb532_pata_irq_handler(int irq, void *dev_instance)
98 {
99         struct ata_host *ah = dev_instance;
100         struct rb532_cf_info *info = ah->private_data;
101
102         if (gpio_get_value(info->gpio_line)) {
103                 set_irq_type(info->irq, IRQ_TYPE_LEVEL_LOW);
104                 if (!info->frozen)
105                         ata_sff_interrupt(info->irq, dev_instance);
106         } else {
107                 set_irq_type(info->irq, IRQ_TYPE_LEVEL_HIGH);
108         }
109
110         return IRQ_HANDLED;
111 }
112
113 static struct ata_port_operations rb532_pata_port_ops = {
114         .inherits               = &ata_sff_port_ops,
115         .sff_exec_command       = rb532_pata_exec_command,
116         .sff_data_xfer          = rb532_pata_data_xfer,
117         .freeze                 = rb532_pata_freeze,
118         .thaw                   = rb532_pata_thaw,
119 };
120
121 /* ------------------------------------------------------------------------ */
122
123 static struct scsi_host_template rb532_pata_sht = {
124         ATA_PIO_SHT(DRV_NAME),
125 };
126
127 /* ------------------------------------------------------------------------ */
128
129 static void rb532_pata_setup_ports(struct ata_host *ah)
130 {
131         struct rb532_cf_info *info = ah->private_data;
132         struct ata_port *ap;
133
134         ap = ah->ports[0];
135
136         ap->ops         = &rb532_pata_port_ops;
137         ap->pio_mask    = 0x1f; /* PIO4 */
138         ap->flags       = ATA_FLAG_NO_LEGACY | ATA_FLAG_MMIO;
139
140         ap->ioaddr.cmd_addr     = info->iobase + RB500_CF_REG_BASE;
141         ap->ioaddr.ctl_addr     = info->iobase + RB500_CF_REG_CTRL;
142         ap->ioaddr.altstatus_addr = info->iobase + RB500_CF_REG_CTRL;
143
144         ata_sff_std_ports(&ap->ioaddr);
145
146         ap->ioaddr.data_addr    = info->iobase + RB500_CF_REG_DBUF32;
147         ap->ioaddr.error_addr   = info->iobase + RB500_CF_REG_ERR;
148 }
149
150 static __devinit int rb532_pata_driver_probe(struct platform_device *pdev)
151 {
152         unsigned int irq;
153         int gpio;
154         struct resource *res;
155         struct ata_host *ah;
156         struct rb532_cf_info *info;
157         int ret;
158
159         res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
160         if (!res) {
161                 dev_err(&pdev->dev, "no IOMEM resource found\n");
162                 return -EINVAL;
163         }
164
165         irq = platform_get_irq(pdev, 0);
166         if (irq <= 0) {
167                 dev_err(&pdev->dev, "no IRQ resource found\n");
168                 return -ENOENT;
169         }
170
171         gpio = irq_to_gpio(irq);
172         if (gpio < 0) {
173                 dev_err(&pdev->dev, "no GPIO found for irq%d\n", irq);
174                 return -ENOENT;
175         }
176
177         ret = gpio_request(gpio, DRV_NAME);
178         if (ret) {
179                 dev_err(&pdev->dev, "GPIO request failed\n");
180                 return ret;
181         }
182
183         /* allocate host */
184         ah = ata_host_alloc(&pdev->dev, RB500_CF_MAXPORTS);
185         if (!ah)
186                 return -ENOMEM;
187
188         platform_set_drvdata(pdev, ah);
189
190         info = devm_kzalloc(&pdev->dev, sizeof(*info), GFP_KERNEL);
191         if (!info)
192                 return -ENOMEM;
193
194         ah->private_data = info;
195         info->gpio_line = gpio;
196         info->irq = irq;
197
198         info->iobase = devm_ioremap_nocache(&pdev->dev, res->start,
199                                 res->end - res->start + 1);
200         if (!info->iobase)
201                 return -ENOMEM;
202
203         ret = gpio_direction_input(gpio);
204         if (ret) {
205                 dev_err(&pdev->dev, "unable to set GPIO direction, err=%d\n",
206                                 ret);
207                 goto err_free_gpio;
208         }
209
210         rb532_pata_setup_ports(ah);
211
212         ret = ata_host_activate(ah, irq, rb532_pata_irq_handler,
213                                 IRQF_TRIGGER_LOW, &rb532_pata_sht);
214         if (ret)
215                 goto err_free_gpio;
216
217         return 0;
218
219 err_free_gpio:
220         gpio_free(gpio);
221
222         return ret;
223 }
224
225 static __devexit int rb532_pata_driver_remove(struct platform_device *pdev)
226 {
227         struct ata_host *ah = platform_get_drvdata(pdev);
228         struct rb532_cf_info *info = ah->private_data;
229
230         ata_host_detach(ah);
231         gpio_free(info->gpio_line);
232
233         return 0;
234 }
235
236 /* work with hotplug and coldplug */
237 MODULE_ALIAS("platform:" DRV_NAME);
238
239 static struct platform_driver rb532_pata_platform_driver = {
240         .probe          = rb532_pata_driver_probe,
241         .remove         = __devexit_p(rb532_pata_driver_remove),
242         .driver  = {
243                 .name   = DRV_NAME,
244                 .owner  = THIS_MODULE,
245         },
246 };
247
248 /* ------------------------------------------------------------------------ */
249
250 #define DRV_INFO DRV_DESC " version " DRV_VERSION
251
252 static int __init rb532_pata_module_init(void)
253 {
254         printk(KERN_INFO DRV_INFO "\n");
255
256         return platform_driver_register(&rb532_pata_platform_driver);
257 }
258
259 static void __exit rb532_pata_module_exit(void)
260 {
261         platform_driver_unregister(&rb532_pata_platform_driver);
262 }
263
264 MODULE_AUTHOR("Gabor Juhos <juhosg at openwrt.org>");
265 MODULE_AUTHOR("Florian Fainelli <florian@openwrt.org>");
266 MODULE_DESCRIPTION(DRV_DESC);
267 MODULE_VERSION(DRV_VERSION);
268 MODULE_LICENSE("GPL");
269
270 module_init(rb532_pata_module_init);
271 module_exit(rb532_pata_module_exit);