2 * A low-level PATA driver to handle a Compact Flash connected on the
3 * Mikrotik's RouterBoard 532 board.
5 * Copyright (C) 2007 Gabor Juhos <juhosg at openwrt.org>
6 * Copyright (C) 2008 Florian Fainelli <florian@openwrt.org>
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>
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.
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.
22 #include <linux/kernel.h>
23 #include <linux/module.h>
24 #include <linux/platform_device.h>
27 #include <linux/interrupt.h>
28 #include <linux/irq.h>
30 #include <linux/libata.h>
31 #include <scsi/scsi_host.h>
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"
39 #define RB500_CF_MAXPORTS 1
40 #define RB500_CF_IO_DELAY 400
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
48 struct rb532_cf_info
{
50 unsigned int gpio_line
;
55 /* ------------------------------------------------------------------------ */
57 static inline void rb532_pata_finish_io(struct ata_port
*ap
)
59 struct ata_host
*ah
= ap
->host
;
60 struct rb532_cf_info
*info
= ah
->private_data
;
62 /* FIXME: Keep previous delay. If this is merely a fence then
63 ata_sff_sync might be sufficient. */
64 ata_sff_dma_pause(ap
);
65 ndelay(RB500_CF_IO_DELAY
);
67 set_irq_type(info
->irq
, IRQ_TYPE_LEVEL_HIGH
);
70 static void rb532_pata_exec_command(struct ata_port
*ap
,
71 const struct ata_taskfile
*tf
)
73 writeb(tf
->command
, ap
->ioaddr
.command_addr
);
74 rb532_pata_finish_io(ap
);
77 static unsigned int rb532_pata_data_xfer(struct ata_device
*adev
, unsigned char *buf
,
78 unsigned int buflen
, int write_data
)
80 struct ata_port
*ap
= adev
->link
->ap
;
81 void __iomem
*ioaddr
= ap
->ioaddr
.data_addr
;
85 for (; buflen
> 0; buflen
--, buf
++)
88 for (; buflen
> 0; buflen
--, buf
++)
92 rb532_pata_finish_io(adev
->link
->ap
);
96 static void rb532_pata_freeze(struct ata_port
*ap
)
98 struct rb532_cf_info
*info
= ap
->host
->private_data
;
103 static void rb532_pata_thaw(struct ata_port
*ap
)
105 struct rb532_cf_info
*info
= ap
->host
->private_data
;
110 static irqreturn_t
rb532_pata_irq_handler(int irq
, void *dev_instance
)
112 struct ata_host
*ah
= dev_instance
;
113 struct rb532_cf_info
*info
= ah
->private_data
;
115 if (gpio_get_value(info
->gpio_line
)) {
116 set_irq_type(info
->irq
, IRQ_TYPE_LEVEL_LOW
);
118 ata_sff_interrupt(info
->irq
, dev_instance
);
120 set_irq_type(info
->irq
, IRQ_TYPE_LEVEL_HIGH
);
126 static struct ata_port_operations rb532_pata_port_ops
= {
127 .inherits
= &ata_sff_port_ops
,
128 .sff_exec_command
= rb532_pata_exec_command
,
129 .sff_data_xfer
= rb532_pata_data_xfer
,
130 .freeze
= rb532_pata_freeze
,
131 .thaw
= rb532_pata_thaw
,
134 /* ------------------------------------------------------------------------ */
136 static struct scsi_host_template rb532_pata_sht
= {
137 ATA_PIO_SHT(DRV_NAME
),
140 /* ------------------------------------------------------------------------ */
142 static void rb532_pata_setup_ports(struct ata_host
*ah
)
144 struct rb532_cf_info
*info
= ah
->private_data
;
149 ap
->ops
= &rb532_pata_port_ops
;
150 ap
->pio_mask
= 0x1f; /* PIO4 */
151 ap
->flags
= ATA_FLAG_NO_LEGACY
| ATA_FLAG_MMIO
;
153 ap
->ioaddr
.cmd_addr
= info
->iobase
+ RB500_CF_REG_BASE
;
154 ap
->ioaddr
.ctl_addr
= info
->iobase
+ RB500_CF_REG_CTRL
;
155 ap
->ioaddr
.altstatus_addr
= info
->iobase
+ RB500_CF_REG_CTRL
;
157 ata_sff_std_ports(&ap
->ioaddr
);
159 ap
->ioaddr
.data_addr
= info
->iobase
+ RB500_CF_REG_DBUF32
;
160 ap
->ioaddr
.error_addr
= info
->iobase
+ RB500_CF_REG_ERR
;
163 static __devinit
int rb532_pata_driver_probe(struct platform_device
*pdev
)
167 struct resource
*res
;
169 struct rb532_cf_info
*info
;
172 res
= platform_get_resource(pdev
, IORESOURCE_MEM
, 0);
174 dev_err(&pdev
->dev
, "no IOMEM resource found\n");
178 irq
= platform_get_irq(pdev
, 0);
180 dev_err(&pdev
->dev
, "no IRQ resource found\n");
184 gpio
= irq_to_gpio(irq
);
186 dev_err(&pdev
->dev
, "no GPIO found for irq%d\n", irq
);
190 ret
= gpio_request(gpio
, DRV_NAME
);
192 dev_err(&pdev
->dev
, "GPIO request failed\n");
197 ah
= ata_host_alloc(&pdev
->dev
, RB500_CF_MAXPORTS
);
201 platform_set_drvdata(pdev
, ah
);
203 info
= devm_kzalloc(&pdev
->dev
, sizeof(*info
), GFP_KERNEL
);
207 ah
->private_data
= info
;
208 info
->gpio_line
= gpio
;
211 info
->iobase
= devm_ioremap_nocache(&pdev
->dev
, res
->start
,
212 res
->end
- res
->start
+ 1);
216 ret
= gpio_direction_input(gpio
);
218 dev_err(&pdev
->dev
, "unable to set GPIO direction, err=%d\n",
223 rb532_pata_setup_ports(ah
);
225 ret
= ata_host_activate(ah
, irq
, rb532_pata_irq_handler
,
226 IRQF_TRIGGER_LOW
, &rb532_pata_sht
);
238 static __devexit
int rb532_pata_driver_remove(struct platform_device
*pdev
)
240 struct ata_host
*ah
= platform_get_drvdata(pdev
);
241 struct rb532_cf_info
*info
= ah
->private_data
;
244 gpio_free(info
->gpio_line
);
249 /* work with hotplug and coldplug */
250 MODULE_ALIAS("platform:" DRV_NAME
);
252 static struct platform_driver rb532_pata_platform_driver
= {
253 .probe
= rb532_pata_driver_probe
,
254 .remove
= __devexit_p(rb532_pata_driver_remove
),
257 .owner
= THIS_MODULE
,
261 /* ------------------------------------------------------------------------ */
263 #define DRV_INFO DRV_DESC " version " DRV_VERSION
265 static int __init
rb532_pata_module_init(void)
267 printk(KERN_INFO DRV_INFO
"\n");
269 return platform_driver_register(&rb532_pata_platform_driver
);
272 static void __exit
rb532_pata_module_exit(void)
274 platform_driver_unregister(&rb532_pata_platform_driver
);
277 MODULE_AUTHOR("Gabor Juhos <juhosg at openwrt.org>");
278 MODULE_AUTHOR("Florian Fainelli <florian@openwrt.org>");
279 MODULE_DESCRIPTION(DRV_DESC
);
280 MODULE_VERSION(DRV_VERSION
);
281 MODULE_LICENSE("GPL");
283 module_init(rb532_pata_module_init
);
284 module_exit(rb532_pata_module_exit
);