Version:  2.0.40 2.2.26 2.4.37 3.11 3.12 3.13 3.14 3.15 3.16 3.17 3.18 3.19 4.0 4.1 4.2 4.3 4.4 4.5 4.6 4.7 4.8

Linux/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/gfp.h>
 23 #include <linux/kernel.h>
 24 #include <linux/module.h>
 25 #include <linux/platform_device.h>
 26 
 27 #include <linux/io.h>
 28 #include <linux/interrupt.h>
 29 #include <linux/irq.h>
 30 #include <linux/gpio.h>
 31 
 32 #include <linux/libata.h>
 33 #include <scsi/scsi_host.h>
 34 
 35 #include <asm/mach-rc32434/rb.h>
 36 
 37 #define DRV_NAME        "pata-rb532-cf"
 38 #define DRV_VERSION     "0.1.0"
 39 #define DRV_DESC        "PATA driver for RouterBOARD 532 Compact Flash"
 40 
 41 #define RB500_CF_MAXPORTS       1
 42 #define RB500_CF_IO_DELAY       400
 43 
 44 #define RB500_CF_REG_BASE       0x0800
 45 #define RB500_CF_REG_ERR        0x080D
 46 #define RB500_CF_REG_CTRL       0x080E
 47 /* 32bit buffered data register offset */
 48 #define RB500_CF_REG_DBUF32     0x0C00
 49 
 50 struct rb532_cf_info {
 51         void __iomem    *iobase;
 52         unsigned int    gpio_line;
 53         unsigned int    irq;
 54 };
 55 
 56 /* ------------------------------------------------------------------------ */
 57 
 58 static irqreturn_t rb532_pata_irq_handler(int irq, void *dev_instance)
 59 {
 60         struct ata_host *ah = dev_instance;
 61         struct rb532_cf_info *info = ah->private_data;
 62 
 63         if (gpio_get_value(info->gpio_line)) {
 64                 irq_set_irq_type(info->irq, IRQ_TYPE_LEVEL_LOW);
 65                 ata_sff_interrupt(info->irq, dev_instance);
 66         } else {
 67                 irq_set_irq_type(info->irq, IRQ_TYPE_LEVEL_HIGH);
 68         }
 69 
 70         return IRQ_HANDLED;
 71 }
 72 
 73 static struct ata_port_operations rb532_pata_port_ops = {
 74         .inherits               = &ata_sff_port_ops,
 75         .sff_data_xfer          = ata_sff_data_xfer32,
 76 };
 77 
 78 /* ------------------------------------------------------------------------ */
 79 
 80 static struct scsi_host_template rb532_pata_sht = {
 81         ATA_PIO_SHT(DRV_NAME),
 82 };
 83 
 84 /* ------------------------------------------------------------------------ */
 85 
 86 static void rb532_pata_setup_ports(struct ata_host *ah)
 87 {
 88         struct rb532_cf_info *info = ah->private_data;
 89         struct ata_port *ap;
 90 
 91         ap = ah->ports[0];
 92 
 93         ap->ops         = &rb532_pata_port_ops;
 94         ap->pio_mask    = ATA_PIO4;
 95 
 96         ap->ioaddr.cmd_addr     = info->iobase + RB500_CF_REG_BASE;
 97         ap->ioaddr.ctl_addr     = info->iobase + RB500_CF_REG_CTRL;
 98         ap->ioaddr.altstatus_addr = info->iobase + RB500_CF_REG_CTRL;
 99 
100         ata_sff_std_ports(&ap->ioaddr);
101 
102         ap->ioaddr.data_addr    = info->iobase + RB500_CF_REG_DBUF32;
103         ap->ioaddr.error_addr   = info->iobase + RB500_CF_REG_ERR;
104 }
105 
106 static int rb532_pata_driver_probe(struct platform_device *pdev)
107 {
108         int irq;
109         int gpio;
110         struct resource *res;
111         struct ata_host *ah;
112         struct cf_device *pdata;
113         struct rb532_cf_info *info;
114         int ret;
115 
116         res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
117         if (!res) {
118                 dev_err(&pdev->dev, "no IOMEM resource found\n");
119                 return -EINVAL;
120         }
121 
122         irq = platform_get_irq(pdev, 0);
123         if (irq <= 0) {
124                 dev_err(&pdev->dev, "no IRQ resource found\n");
125                 return -ENOENT;
126         }
127 
128         pdata = dev_get_platdata(&pdev->dev);
129         if (!pdata) {
130                 dev_err(&pdev->dev, "no platform data specified\n");
131                 return -EINVAL;
132         }
133 
134         gpio = pdata->gpio_pin;
135         if (gpio < 0) {
136                 dev_err(&pdev->dev, "no GPIO found for irq%d\n", irq);
137                 return -ENOENT;
138         }
139 
140         ret = gpio_request(gpio, DRV_NAME);
141         if (ret) {
142                 dev_err(&pdev->dev, "GPIO request failed\n");
143                 return ret;
144         }
145 
146         /* allocate host */
147         ah = ata_host_alloc(&pdev->dev, RB500_CF_MAXPORTS);
148         if (!ah)
149                 return -ENOMEM;
150 
151         platform_set_drvdata(pdev, ah);
152 
153         info = devm_kzalloc(&pdev->dev, sizeof(*info), GFP_KERNEL);
154         if (!info)
155                 return -ENOMEM;
156 
157         ah->private_data = info;
158         info->gpio_line = gpio;
159         info->irq = irq;
160 
161         info->iobase = devm_ioremap_nocache(&pdev->dev, res->start,
162                                 resource_size(res));
163         if (!info->iobase)
164                 return -ENOMEM;
165 
166         ret = gpio_direction_input(gpio);
167         if (ret) {
168                 dev_err(&pdev->dev, "unable to set GPIO direction, err=%d\n",
169                                 ret);
170                 goto err_free_gpio;
171         }
172 
173         rb532_pata_setup_ports(ah);
174 
175         ret = ata_host_activate(ah, irq, rb532_pata_irq_handler,
176                                 IRQF_TRIGGER_LOW, &rb532_pata_sht);
177         if (ret)
178                 goto err_free_gpio;
179 
180         return 0;
181 
182 err_free_gpio:
183         gpio_free(gpio);
184 
185         return ret;
186 }
187 
188 static int rb532_pata_driver_remove(struct platform_device *pdev)
189 {
190         struct ata_host *ah = platform_get_drvdata(pdev);
191         struct rb532_cf_info *info = ah->private_data;
192 
193         ata_host_detach(ah);
194         gpio_free(info->gpio_line);
195 
196         return 0;
197 }
198 
199 static struct platform_driver rb532_pata_platform_driver = {
200         .probe          = rb532_pata_driver_probe,
201         .remove         = rb532_pata_driver_remove,
202         .driver  = {
203                 .name   = DRV_NAME,
204         },
205 };
206 
207 #define DRV_INFO DRV_DESC " version " DRV_VERSION
208 
209 module_platform_driver(rb532_pata_platform_driver);
210 
211 MODULE_AUTHOR("Gabor Juhos <juhosg at openwrt.org>");
212 MODULE_AUTHOR("Florian Fainelli <florian@openwrt.org>");
213 MODULE_DESCRIPTION(DRV_DESC);
214 MODULE_VERSION(DRV_VERSION);
215 MODULE_LICENSE("GPL");
216 MODULE_ALIAS("platform:" DRV_NAME);
217 

This page was automatically generated by LXR 0.3.1 (source).  •  Linux is a registered trademark of Linus Torvalds  •  Contact us