Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 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-rb500-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_CMD 0x0800 |
| 43 | #define RB500_CF_REG_CTRL 0x080E |
| 44 | #define RB500_CF_REG_DATA 0x0C00 |
| 45 | |
| 46 | struct rb500_cf_info { |
| 47 | void __iomem *iobase; |
| 48 | unsigned int gpio_line; |
| 49 | int frozen; |
| 50 | unsigned int irq; |
| 51 | }; |
| 52 | |
| 53 | /* ------------------------------------------------------------------------ */ |
| 54 | |
| 55 | static inline void rb500_pata_finish_io(struct ata_port *ap) |
| 56 | { |
| 57 | struct ata_host *ah = ap->host; |
| 58 | struct rb500_cf_info *info = ah->private_data; |
| 59 | |
| 60 | ata_altstatus(ap); |
| 61 | ndelay(RB500_CF_IO_DELAY); |
| 62 | |
| 63 | set_irq_type(info->irq, IRQ_TYPE_LEVEL_HIGH); |
| 64 | } |
| 65 | |
| 66 | static void rb500_pata_exec_command(struct ata_port *ap, |
| 67 | const struct ata_taskfile *tf) |
| 68 | { |
| 69 | writeb(tf->command, ap->ioaddr.command_addr); |
| 70 | rb500_pata_finish_io(ap); |
| 71 | } |
| 72 | |
| 73 | static void rb500_pata_data_xfer(struct ata_device *adev, unsigned char *buf, |
| 74 | unsigned int buflen, int write_data) |
| 75 | { |
| 76 | struct ata_port *ap = adev->link->ap; |
| 77 | void __iomem *ioaddr = ap->ioaddr.data_addr; |
| 78 | |
| 79 | if (write_data) { |
| 80 | for (; buflen > 0; buflen--, buf++) |
| 81 | writeb(*buf, ioaddr); |
| 82 | } else { |
| 83 | for (; buflen > 0; buflen--, buf++) |
| 84 | *buf = readb(ioaddr); |
| 85 | } |
| 86 | |
| 87 | rb500_pata_finish_io(adev->link->ap); |
| 88 | } |
| 89 | |
| 90 | static void rb500_pata_freeze(struct ata_port *ap) |
| 91 | { |
| 92 | struct rb500_cf_info *info = ap->host->private_data; |
| 93 | |
| 94 | info->frozen = 1; |
| 95 | } |
| 96 | |
| 97 | static void rb500_pata_thaw(struct ata_port *ap) |
| 98 | { |
| 99 | struct rb500_cf_info *info = ap->host->private_data; |
| 100 | |
| 101 | info->frozen = 0; |
| 102 | } |
| 103 | |
| 104 | static irqreturn_t rb500_pata_irq_handler(int irq, void *dev_instance) |
| 105 | { |
| 106 | struct ata_host *ah = dev_instance; |
| 107 | struct rb500_cf_info *info = ah->private_data; |
| 108 | |
| 109 | if (gpio_get_value(info->gpio_line)) { |
| 110 | set_irq_type(info->irq, IRQ_TYPE_LEVEL_LOW); |
| 111 | if (!info->frozen) |
| 112 | ata_interrupt(info->irq, dev_instance); |
| 113 | } else { |
| 114 | set_irq_type(info->irq, IRQ_TYPE_LEVEL_HIGH); |
| 115 | } |
| 116 | |
| 117 | return IRQ_HANDLED; |
| 118 | } |
| 119 | |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 120 | static struct ata_port_operations rb500_pata_port_ops = { |
| 121 | .tf_load = ata_tf_load, |
| 122 | .tf_read = ata_tf_read, |
| 123 | |
| 124 | .exec_command = rb500_pata_exec_command, |
| 125 | .check_status = ata_check_status, |
| 126 | .dev_select = ata_std_dev_select, |
| 127 | |
| 128 | .data_xfer = rb500_pata_data_xfer, |
| 129 | |
| 130 | .qc_prep = ata_qc_prep, |
| 131 | .qc_issue = ata_qc_issue_prot, |
| 132 | |
| 133 | .freeze = rb500_pata_freeze, |
| 134 | .thaw = rb500_pata_thaw, |
| 135 | .error_handler = ata_bmdma_error_handler, |
Tejun Heo | 6bd99b4 | 2008-03-25 12:22:48 +0900 | [diff] [blame] | 136 | .post_internal_cmd = ata_bmdma_post_internal_cmd, |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 137 | |
Tejun Heo | 358f9a7 | 2008-03-25 12:22:47 +0900 | [diff] [blame] | 138 | .irq_clear = ata_noop_irq_clear, |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 139 | .irq_on = ata_irq_on, |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 140 | }; |
| 141 | |
| 142 | /* ------------------------------------------------------------------------ */ |
| 143 | |
| 144 | static struct scsi_host_template rb500_pata_sht = { |
Tejun Heo | 68d1d07 | 2008-03-25 12:22:49 +0900 | [diff] [blame^] | 145 | ATA_PIO_SHT(DRV_NAME), |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 146 | }; |
| 147 | |
| 148 | /* ------------------------------------------------------------------------ */ |
| 149 | |
| 150 | static void rb500_pata_setup_ports(struct ata_host *ah) |
| 151 | { |
| 152 | struct rb500_cf_info *info = ah->private_data; |
| 153 | struct ata_port *ap; |
| 154 | |
| 155 | ap = ah->ports[0]; |
| 156 | |
| 157 | ap->ops = &rb500_pata_port_ops; |
| 158 | ap->pio_mask = 0x1f; /* PIO4 */ |
| 159 | ap->flags = ATA_FLAG_NO_LEGACY | ATA_FLAG_MMIO; |
| 160 | |
| 161 | ap->ioaddr.cmd_addr = info->iobase + RB500_CF_REG_CMD; |
| 162 | ap->ioaddr.ctl_addr = info->iobase + RB500_CF_REG_CTRL; |
| 163 | ap->ioaddr.altstatus_addr = info->iobase + RB500_CF_REG_CTRL; |
| 164 | |
| 165 | ata_std_ports(&ap->ioaddr); |
| 166 | |
| 167 | ap->ioaddr.data_addr = info->iobase + RB500_CF_REG_DATA; |
| 168 | } |
| 169 | |
| 170 | static __devinit int rb500_pata_driver_probe(struct platform_device *pdev) |
| 171 | { |
| 172 | unsigned int irq; |
| 173 | int gpio; |
| 174 | struct resource *res; |
| 175 | struct ata_host *ah; |
| 176 | struct rb500_cf_info *info; |
| 177 | int ret; |
| 178 | |
| 179 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
| 180 | if (!res) { |
| 181 | dev_err(&pdev->dev, "no IOMEM resource found\n"); |
| 182 | return -EINVAL; |
| 183 | } |
| 184 | |
| 185 | irq = platform_get_irq(pdev, 0); |
| 186 | if (irq <= 0) { |
| 187 | dev_err(&pdev->dev, "no IRQ resource found\n"); |
| 188 | return -ENOENT; |
| 189 | } |
| 190 | |
| 191 | gpio = irq_to_gpio(irq); |
| 192 | if (gpio < 0) { |
| 193 | dev_err(&pdev->dev, "no GPIO found for irq%d\n", irq); |
| 194 | return -ENOENT; |
| 195 | } |
| 196 | |
| 197 | ret = gpio_request(gpio, DRV_NAME); |
| 198 | if (ret) { |
| 199 | dev_err(&pdev->dev, "GPIO request failed\n"); |
| 200 | return ret; |
| 201 | } |
| 202 | |
| 203 | /* allocate host */ |
| 204 | ah = ata_host_alloc(&pdev->dev, RB500_CF_MAXPORTS); |
| 205 | if (!ah) |
| 206 | return -ENOMEM; |
| 207 | |
| 208 | platform_set_drvdata(pdev, ah); |
| 209 | |
| 210 | info = devm_kzalloc(&pdev->dev, sizeof(*info), GFP_KERNEL); |
| 211 | if (!info) |
| 212 | return -ENOMEM; |
| 213 | |
| 214 | ah->private_data = info; |
| 215 | info->gpio_line = gpio; |
| 216 | info->irq = irq; |
| 217 | |
| 218 | info->iobase = devm_ioremap_nocache(&pdev->dev, res->start, |
| 219 | res->end - res->start + 1); |
| 220 | if (!info->iobase) |
| 221 | return -ENOMEM; |
| 222 | |
| 223 | ret = gpio_direction_input(gpio); |
| 224 | if (ret) { |
| 225 | dev_err(&pdev->dev, "unable to set GPIO direction, err=%d\n", |
| 226 | ret); |
| 227 | goto err_free_gpio; |
| 228 | } |
| 229 | |
| 230 | rb500_pata_setup_ports(ah); |
| 231 | |
| 232 | ret = ata_host_activate(ah, irq, rb500_pata_irq_handler, |
| 233 | IRQF_TRIGGER_LOW, &rb500_pata_sht); |
| 234 | if (ret) |
| 235 | goto err_free_gpio; |
| 236 | |
| 237 | return 0; |
| 238 | |
| 239 | err_free_gpio: |
| 240 | gpio_free(gpio); |
| 241 | |
| 242 | return ret; |
| 243 | } |
| 244 | |
| 245 | static __devexit int rb500_pata_driver_remove(struct platform_device *pdev) |
| 246 | { |
| 247 | struct ata_host *ah = platform_get_drvdata(pdev); |
| 248 | struct rb500_cf_info *info = ah->private_data; |
| 249 | |
| 250 | ata_host_detach(ah); |
| 251 | gpio_free(info->gpio_line); |
| 252 | |
| 253 | return 0; |
| 254 | } |
| 255 | |
| 256 | static struct platform_driver rb500_pata_platform_driver = { |
| 257 | .probe = rb500_pata_driver_probe, |
| 258 | .remove = __devexit_p(rb500_pata_driver_remove), |
| 259 | .driver = { |
| 260 | .name = DRV_NAME, |
| 261 | .owner = THIS_MODULE, |
| 262 | }, |
| 263 | }; |
| 264 | |
| 265 | /* ------------------------------------------------------------------------ */ |
| 266 | |
| 267 | #define DRV_INFO DRV_DESC " version " DRV_VERSION |
| 268 | |
| 269 | static int __init rb500_pata_module_init(void) |
| 270 | { |
| 271 | printk(KERN_INFO DRV_INFO "\n"); |
| 272 | |
| 273 | return platform_driver_register(&rb500_pata_platform_driver); |
| 274 | } |
| 275 | |
| 276 | static void __exit rb500_pata_module_exit(void) |
| 277 | { |
| 278 | platform_driver_unregister(&rb500_pata_platform_driver); |
| 279 | } |
| 280 | |
| 281 | MODULE_AUTHOR("Gabor Juhos <juhosg at openwrt.org>"); |
| 282 | MODULE_AUTHOR("Florian Fainelli <florian@openwrt.org>"); |
| 283 | MODULE_DESCRIPTION(DRV_DESC); |
| 284 | MODULE_VERSION(DRV_VERSION); |
| 285 | MODULE_LICENSE("GPL"); |
| 286 | |
| 287 | module_init(rb500_pata_module_init); |
| 288 | module_exit(rb500_pata_module_exit); |