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 | |
Ralf Baechle | 3dd654b | 2008-04-28 12:41:36 +0100 | [diff] [blame] | 35 | #define DRV_NAME "pata-rb532-cf" |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 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 | |
Phil Sutter | 9f14786 | 2008-11-28 20:48:26 +0100 | [diff] [blame] | 42 | #define RB500_CF_REG_BASE 0x0800 |
| 43 | #define RB500_CF_REG_ERR 0x080D |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 44 | #define RB500_CF_REG_CTRL 0x080E |
Phil Sutter | 9f14786 | 2008-11-28 20:48:26 +0100 | [diff] [blame] | 45 | /* 32bit buffered data register offset */ |
| 46 | #define RB500_CF_REG_DBUF32 0x0C00 |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 47 | |
Ralf Baechle | 3dd654b | 2008-04-28 12:41:36 +0100 | [diff] [blame] | 48 | struct rb532_cf_info { |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 49 | void __iomem *iobase; |
| 50 | unsigned int gpio_line; |
| 51 | int frozen; |
| 52 | unsigned int irq; |
| 53 | }; |
| 54 | |
| 55 | /* ------------------------------------------------------------------------ */ |
| 56 | |
Ralf Baechle | 3dd654b | 2008-04-28 12:41:36 +0100 | [diff] [blame] | 57 | static void rb532_pata_freeze(struct ata_port *ap) |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 58 | { |
Ralf Baechle | 3dd654b | 2008-04-28 12:41:36 +0100 | [diff] [blame] | 59 | struct rb532_cf_info *info = ap->host->private_data; |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 60 | |
| 61 | info->frozen = 1; |
| 62 | } |
| 63 | |
Ralf Baechle | 3dd654b | 2008-04-28 12:41:36 +0100 | [diff] [blame] | 64 | static void rb532_pata_thaw(struct ata_port *ap) |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 65 | { |
Ralf Baechle | 3dd654b | 2008-04-28 12:41:36 +0100 | [diff] [blame] | 66 | struct rb532_cf_info *info = ap->host->private_data; |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 67 | |
| 68 | info->frozen = 0; |
| 69 | } |
| 70 | |
Ralf Baechle | 3dd654b | 2008-04-28 12:41:36 +0100 | [diff] [blame] | 71 | static irqreturn_t rb532_pata_irq_handler(int irq, void *dev_instance) |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 72 | { |
| 73 | struct ata_host *ah = dev_instance; |
Ralf Baechle | 3dd654b | 2008-04-28 12:41:36 +0100 | [diff] [blame] | 74 | struct rb532_cf_info *info = ah->private_data; |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 75 | |
| 76 | if (gpio_get_value(info->gpio_line)) { |
| 77 | set_irq_type(info->irq, IRQ_TYPE_LEVEL_LOW); |
| 78 | if (!info->frozen) |
Tejun Heo | 9363c38 | 2008-04-07 22:47:16 +0900 | [diff] [blame] | 79 | ata_sff_interrupt(info->irq, dev_instance); |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 80 | } else { |
| 81 | set_irq_type(info->irq, IRQ_TYPE_LEVEL_HIGH); |
| 82 | } |
| 83 | |
| 84 | return IRQ_HANDLED; |
| 85 | } |
| 86 | |
Ralf Baechle | 3dd654b | 2008-04-28 12:41:36 +0100 | [diff] [blame] | 87 | static struct ata_port_operations rb532_pata_port_ops = { |
Tejun Heo | 029cfd6 | 2008-03-25 12:22:49 +0900 | [diff] [blame] | 88 | .inherits = &ata_sff_port_ops, |
Phil Sutter | 180bd14 | 2009-01-27 14:35:52 +0100 | [diff] [blame^] | 89 | .sff_data_xfer = ata_sff_data_xfer32, |
Ralf Baechle | 3dd654b | 2008-04-28 12:41:36 +0100 | [diff] [blame] | 90 | .freeze = rb532_pata_freeze, |
| 91 | .thaw = rb532_pata_thaw, |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 92 | }; |
| 93 | |
| 94 | /* ------------------------------------------------------------------------ */ |
| 95 | |
Ralf Baechle | 3dd654b | 2008-04-28 12:41:36 +0100 | [diff] [blame] | 96 | static struct scsi_host_template rb532_pata_sht = { |
Tejun Heo | 68d1d07 | 2008-03-25 12:22:49 +0900 | [diff] [blame] | 97 | ATA_PIO_SHT(DRV_NAME), |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 98 | }; |
| 99 | |
| 100 | /* ------------------------------------------------------------------------ */ |
| 101 | |
Ralf Baechle | 3dd654b | 2008-04-28 12:41:36 +0100 | [diff] [blame] | 102 | static void rb532_pata_setup_ports(struct ata_host *ah) |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 103 | { |
Ralf Baechle | 3dd654b | 2008-04-28 12:41:36 +0100 | [diff] [blame] | 104 | struct rb532_cf_info *info = ah->private_data; |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 105 | struct ata_port *ap; |
| 106 | |
| 107 | ap = ah->ports[0]; |
| 108 | |
Ralf Baechle | 3dd654b | 2008-04-28 12:41:36 +0100 | [diff] [blame] | 109 | ap->ops = &rb532_pata_port_ops; |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 110 | ap->pio_mask = 0x1f; /* PIO4 */ |
| 111 | ap->flags = ATA_FLAG_NO_LEGACY | ATA_FLAG_MMIO; |
| 112 | |
Phil Sutter | 9f14786 | 2008-11-28 20:48:26 +0100 | [diff] [blame] | 113 | ap->ioaddr.cmd_addr = info->iobase + RB500_CF_REG_BASE; |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 114 | ap->ioaddr.ctl_addr = info->iobase + RB500_CF_REG_CTRL; |
| 115 | ap->ioaddr.altstatus_addr = info->iobase + RB500_CF_REG_CTRL; |
| 116 | |
Tejun Heo | 9363c38 | 2008-04-07 22:47:16 +0900 | [diff] [blame] | 117 | ata_sff_std_ports(&ap->ioaddr); |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 118 | |
Phil Sutter | 9f14786 | 2008-11-28 20:48:26 +0100 | [diff] [blame] | 119 | ap->ioaddr.data_addr = info->iobase + RB500_CF_REG_DBUF32; |
| 120 | ap->ioaddr.error_addr = info->iobase + RB500_CF_REG_ERR; |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 121 | } |
| 122 | |
Ralf Baechle | 3dd654b | 2008-04-28 12:41:36 +0100 | [diff] [blame] | 123 | static __devinit int rb532_pata_driver_probe(struct platform_device *pdev) |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 124 | { |
| 125 | unsigned int irq; |
| 126 | int gpio; |
| 127 | struct resource *res; |
| 128 | struct ata_host *ah; |
Ralf Baechle | 3dd654b | 2008-04-28 12:41:36 +0100 | [diff] [blame] | 129 | struct rb532_cf_info *info; |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 130 | int ret; |
| 131 | |
| 132 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
| 133 | if (!res) { |
| 134 | dev_err(&pdev->dev, "no IOMEM resource found\n"); |
| 135 | return -EINVAL; |
| 136 | } |
| 137 | |
| 138 | irq = platform_get_irq(pdev, 0); |
| 139 | if (irq <= 0) { |
| 140 | dev_err(&pdev->dev, "no IRQ resource found\n"); |
| 141 | return -ENOENT; |
| 142 | } |
| 143 | |
| 144 | gpio = irq_to_gpio(irq); |
| 145 | if (gpio < 0) { |
| 146 | dev_err(&pdev->dev, "no GPIO found for irq%d\n", irq); |
| 147 | return -ENOENT; |
| 148 | } |
| 149 | |
| 150 | ret = gpio_request(gpio, DRV_NAME); |
| 151 | if (ret) { |
| 152 | dev_err(&pdev->dev, "GPIO request failed\n"); |
| 153 | return ret; |
| 154 | } |
| 155 | |
| 156 | /* allocate host */ |
| 157 | ah = ata_host_alloc(&pdev->dev, RB500_CF_MAXPORTS); |
| 158 | if (!ah) |
| 159 | return -ENOMEM; |
| 160 | |
| 161 | platform_set_drvdata(pdev, ah); |
| 162 | |
| 163 | info = devm_kzalloc(&pdev->dev, sizeof(*info), GFP_KERNEL); |
| 164 | if (!info) |
| 165 | return -ENOMEM; |
| 166 | |
| 167 | ah->private_data = info; |
| 168 | info->gpio_line = gpio; |
| 169 | info->irq = irq; |
| 170 | |
| 171 | info->iobase = devm_ioremap_nocache(&pdev->dev, res->start, |
| 172 | res->end - res->start + 1); |
| 173 | if (!info->iobase) |
| 174 | return -ENOMEM; |
| 175 | |
| 176 | ret = gpio_direction_input(gpio); |
| 177 | if (ret) { |
| 178 | dev_err(&pdev->dev, "unable to set GPIO direction, err=%d\n", |
| 179 | ret); |
| 180 | goto err_free_gpio; |
| 181 | } |
| 182 | |
Ralf Baechle | 3dd654b | 2008-04-28 12:41:36 +0100 | [diff] [blame] | 183 | rb532_pata_setup_ports(ah); |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 184 | |
Ralf Baechle | 3dd654b | 2008-04-28 12:41:36 +0100 | [diff] [blame] | 185 | ret = ata_host_activate(ah, irq, rb532_pata_irq_handler, |
| 186 | IRQF_TRIGGER_LOW, &rb532_pata_sht); |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 187 | if (ret) |
| 188 | goto err_free_gpio; |
| 189 | |
| 190 | return 0; |
| 191 | |
| 192 | err_free_gpio: |
| 193 | gpio_free(gpio); |
| 194 | |
| 195 | return ret; |
| 196 | } |
| 197 | |
Ralf Baechle | 3dd654b | 2008-04-28 12:41:36 +0100 | [diff] [blame] | 198 | static __devexit int rb532_pata_driver_remove(struct platform_device *pdev) |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 199 | { |
| 200 | struct ata_host *ah = platform_get_drvdata(pdev); |
Ralf Baechle | 3dd654b | 2008-04-28 12:41:36 +0100 | [diff] [blame] | 201 | struct rb532_cf_info *info = ah->private_data; |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 202 | |
| 203 | ata_host_detach(ah); |
| 204 | gpio_free(info->gpio_line); |
| 205 | |
| 206 | return 0; |
| 207 | } |
| 208 | |
Kay Sievers | 458622f | 2008-04-18 13:41:57 -0700 | [diff] [blame] | 209 | /* work with hotplug and coldplug */ |
| 210 | MODULE_ALIAS("platform:" DRV_NAME); |
| 211 | |
Ralf Baechle | 3dd654b | 2008-04-28 12:41:36 +0100 | [diff] [blame] | 212 | static struct platform_driver rb532_pata_platform_driver = { |
| 213 | .probe = rb532_pata_driver_probe, |
| 214 | .remove = __devexit_p(rb532_pata_driver_remove), |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 215 | .driver = { |
| 216 | .name = DRV_NAME, |
| 217 | .owner = THIS_MODULE, |
| 218 | }, |
| 219 | }; |
| 220 | |
| 221 | /* ------------------------------------------------------------------------ */ |
| 222 | |
| 223 | #define DRV_INFO DRV_DESC " version " DRV_VERSION |
| 224 | |
Ralf Baechle | 3dd654b | 2008-04-28 12:41:36 +0100 | [diff] [blame] | 225 | static int __init rb532_pata_module_init(void) |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 226 | { |
| 227 | printk(KERN_INFO DRV_INFO "\n"); |
| 228 | |
Ralf Baechle | 3dd654b | 2008-04-28 12:41:36 +0100 | [diff] [blame] | 229 | return platform_driver_register(&rb532_pata_platform_driver); |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 230 | } |
| 231 | |
Ralf Baechle | 3dd654b | 2008-04-28 12:41:36 +0100 | [diff] [blame] | 232 | static void __exit rb532_pata_module_exit(void) |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 233 | { |
Ralf Baechle | 3dd654b | 2008-04-28 12:41:36 +0100 | [diff] [blame] | 234 | platform_driver_unregister(&rb532_pata_platform_driver); |
Florian Fainelli | 3db691d | 2008-03-06 12:25:21 +0100 | [diff] [blame] | 235 | } |
| 236 | |
| 237 | MODULE_AUTHOR("Gabor Juhos <juhosg at openwrt.org>"); |
| 238 | MODULE_AUTHOR("Florian Fainelli <florian@openwrt.org>"); |
| 239 | MODULE_DESCRIPTION(DRV_DESC); |
| 240 | MODULE_VERSION(DRV_VERSION); |
| 241 | MODULE_LICENSE("GPL"); |
| 242 | |
Ralf Baechle | 3dd654b | 2008-04-28 12:41:36 +0100 | [diff] [blame] | 243 | module_init(rb532_pata_module_init); |
| 244 | module_exit(rb532_pata_module_exit); |