Blame view

drivers/ata/pata_rb532_cf.c 5.04 KB
3db691daa   Florian Fainelli   [libata] Add supp...
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
  /*
   *  A low-level PATA driver to handle a Compact Flash connected on the
   *  Mikrotik's RouterBoard 532 board.
   *
   *  Copyright (C) 2007 Gabor Juhos <juhosg at openwrt.org>
   *  Copyright (C) 2008 Florian Fainelli <florian@openwrt.org>
   *
   *  This file was based on: drivers/ata/pata_ixp4xx_cf.c
   *	Copyright (C) 2006-07 Tower Technologies
   *	Author: Alessandro Zummo <a.zummo@towertech.it>
   *
   *  Also was based on the driver for Linux 2.4.xx published by Mikrotik for
   *  their RouterBoard 1xx and 5xx series devices. The original Mikrotik code
   *  seems not to have a license.
   *
   *  This program is free software; you can redistribute it and/or modify
   *  it under the terms of the GNU General Public License version 2 as
   *  published by the Free Software Foundation.
   *
   */
5a0e3ad6a   Tejun Heo   include cleanup: ...
21
  #include <linux/gfp.h>
3db691daa   Florian Fainelli   [libata] Add supp...
22
23
24
25
26
27
28
29
30
31
32
33
  #include <linux/kernel.h>
  #include <linux/module.h>
  #include <linux/platform_device.h>
  
  #include <linux/io.h>
  #include <linux/interrupt.h>
  #include <linux/irq.h>
  
  #include <linux/libata.h>
  #include <scsi/scsi_host.h>
  
  #include <asm/gpio.h>
3dd654bfd   Ralf Baechle   [MIPS] ATA: Renam...
34
  #define DRV_NAME	"pata-rb532-cf"
3db691daa   Florian Fainelli   [libata] Add supp...
35
36
37
38
39
  #define DRV_VERSION	"0.1.0"
  #define DRV_DESC	"PATA driver for RouterBOARD 532 Compact Flash"
  
  #define RB500_CF_MAXPORTS	1
  #define RB500_CF_IO_DELAY	400
9f14786e2   Phil Sutter   [libata] pata_rb5...
40
41
  #define RB500_CF_REG_BASE	0x0800
  #define RB500_CF_REG_ERR	0x080D
3db691daa   Florian Fainelli   [libata] Add supp...
42
  #define RB500_CF_REG_CTRL	0x080E
9f14786e2   Phil Sutter   [libata] pata_rb5...
43
44
  /* 32bit buffered data register offset */
  #define RB500_CF_REG_DBUF32	0x0C00
3db691daa   Florian Fainelli   [libata] Add supp...
45

3dd654bfd   Ralf Baechle   [MIPS] ATA: Renam...
46
  struct rb532_cf_info {
3db691daa   Florian Fainelli   [libata] Add supp...
47
48
  	void __iomem	*iobase;
  	unsigned int	gpio_line;
3db691daa   Florian Fainelli   [libata] Add supp...
49
50
51
52
  	unsigned int	irq;
  };
  
  /* ------------------------------------------------------------------------ */
3dd654bfd   Ralf Baechle   [MIPS] ATA: Renam...
53
  static irqreturn_t rb532_pata_irq_handler(int irq, void *dev_instance)
3db691daa   Florian Fainelli   [libata] Add supp...
54
55
  {
  	struct ata_host *ah = dev_instance;
3dd654bfd   Ralf Baechle   [MIPS] ATA: Renam...
56
  	struct rb532_cf_info *info = ah->private_data;
3db691daa   Florian Fainelli   [libata] Add supp...
57
58
  
  	if (gpio_get_value(info->gpio_line)) {
dced35aeb   Thomas Gleixner   drivers: Final ir...
59
  		irq_set_irq_type(info->irq, IRQ_TYPE_LEVEL_LOW);
6be976e79   Phil Sutter   pata-rb532-cf: dr...
60
  		ata_sff_interrupt(info->irq, dev_instance);
3db691daa   Florian Fainelli   [libata] Add supp...
61
  	} else {
dced35aeb   Thomas Gleixner   drivers: Final ir...
62
  		irq_set_irq_type(info->irq, IRQ_TYPE_LEVEL_HIGH);
3db691daa   Florian Fainelli   [libata] Add supp...
63
64
65
66
  	}
  
  	return IRQ_HANDLED;
  }
3dd654bfd   Ralf Baechle   [MIPS] ATA: Renam...
67
  static struct ata_port_operations rb532_pata_port_ops = {
029cfd6b7   Tejun Heo   libata: implement...
68
  	.inherits		= &ata_sff_port_ops,
180bd147f   Phil Sutter   pata-rb532-cf: us...
69
  	.sff_data_xfer		= ata_sff_data_xfer32,
3db691daa   Florian Fainelli   [libata] Add supp...
70
71
72
  };
  
  /* ------------------------------------------------------------------------ */
3dd654bfd   Ralf Baechle   [MIPS] ATA: Renam...
73
  static struct scsi_host_template rb532_pata_sht = {
68d1d07b5   Tejun Heo   libata: implement...
74
  	ATA_PIO_SHT(DRV_NAME),
3db691daa   Florian Fainelli   [libata] Add supp...
75
76
77
  };
  
  /* ------------------------------------------------------------------------ */
3dd654bfd   Ralf Baechle   [MIPS] ATA: Renam...
78
  static void rb532_pata_setup_ports(struct ata_host *ah)
3db691daa   Florian Fainelli   [libata] Add supp...
79
  {
3dd654bfd   Ralf Baechle   [MIPS] ATA: Renam...
80
  	struct rb532_cf_info *info = ah->private_data;
3db691daa   Florian Fainelli   [libata] Add supp...
81
82
83
  	struct ata_port *ap;
  
  	ap = ah->ports[0];
3dd654bfd   Ralf Baechle   [MIPS] ATA: Renam...
84
  	ap->ops		= &rb532_pata_port_ops;
14bdef982   Erik Inge Bolsø   [libata] convert ...
85
  	ap->pio_mask	= ATA_PIO4;
3db691daa   Florian Fainelli   [libata] Add supp...
86

9f14786e2   Phil Sutter   [libata] pata_rb5...
87
  	ap->ioaddr.cmd_addr	= info->iobase + RB500_CF_REG_BASE;
3db691daa   Florian Fainelli   [libata] Add supp...
88
89
  	ap->ioaddr.ctl_addr	= info->iobase + RB500_CF_REG_CTRL;
  	ap->ioaddr.altstatus_addr = info->iobase + RB500_CF_REG_CTRL;
9363c3825   Tejun Heo   libata: rename SF...
90
  	ata_sff_std_ports(&ap->ioaddr);
3db691daa   Florian Fainelli   [libata] Add supp...
91

9f14786e2   Phil Sutter   [libata] pata_rb5...
92
93
  	ap->ioaddr.data_addr	= info->iobase + RB500_CF_REG_DBUF32;
  	ap->ioaddr.error_addr	= info->iobase + RB500_CF_REG_ERR;
3db691daa   Florian Fainelli   [libata] Add supp...
94
  }
3dd654bfd   Ralf Baechle   [MIPS] ATA: Renam...
95
  static __devinit int rb532_pata_driver_probe(struct platform_device *pdev)
3db691daa   Florian Fainelli   [libata] Add supp...
96
  {
9223d01b2   Florian Fainelli   pata-rb532-cf: pl...
97
  	int irq;
3db691daa   Florian Fainelli   [libata] Add supp...
98
99
100
  	int gpio;
  	struct resource *res;
  	struct ata_host *ah;
3dd654bfd   Ralf Baechle   [MIPS] ATA: Renam...
101
  	struct rb532_cf_info *info;
3db691daa   Florian Fainelli   [libata] Add supp...
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
  	int ret;
  
  	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  	if (!res) {
  		dev_err(&pdev->dev, "no IOMEM resource found
  ");
  		return -EINVAL;
  	}
  
  	irq = platform_get_irq(pdev, 0);
  	if (irq <= 0) {
  		dev_err(&pdev->dev, "no IRQ resource found
  ");
  		return -ENOENT;
  	}
  
  	gpio = irq_to_gpio(irq);
  	if (gpio < 0) {
  		dev_err(&pdev->dev, "no GPIO found for irq%d
  ", irq);
  		return -ENOENT;
  	}
  
  	ret = gpio_request(gpio, DRV_NAME);
  	if (ret) {
  		dev_err(&pdev->dev, "GPIO request failed
  ");
  		return ret;
  	}
  
  	/* allocate host */
  	ah = ata_host_alloc(&pdev->dev, RB500_CF_MAXPORTS);
  	if (!ah)
  		return -ENOMEM;
  
  	platform_set_drvdata(pdev, ah);
  
  	info = devm_kzalloc(&pdev->dev, sizeof(*info), GFP_KERNEL);
  	if (!info)
  		return -ENOMEM;
  
  	ah->private_data = info;
  	info->gpio_line = gpio;
  	info->irq = irq;
  
  	info->iobase = devm_ioremap_nocache(&pdev->dev, res->start,
041b5eac2   Julia Lawall   drivers/ata: use ...
148
  				resource_size(res));
3db691daa   Florian Fainelli   [libata] Add supp...
149
150
151
152
153
154
155
156
157
158
  	if (!info->iobase)
  		return -ENOMEM;
  
  	ret = gpio_direction_input(gpio);
  	if (ret) {
  		dev_err(&pdev->dev, "unable to set GPIO direction, err=%d
  ",
  				ret);
  		goto err_free_gpio;
  	}
3dd654bfd   Ralf Baechle   [MIPS] ATA: Renam...
159
  	rb532_pata_setup_ports(ah);
3db691daa   Florian Fainelli   [libata] Add supp...
160

3dd654bfd   Ralf Baechle   [MIPS] ATA: Renam...
161
162
  	ret = ata_host_activate(ah, irq, rb532_pata_irq_handler,
  				IRQF_TRIGGER_LOW, &rb532_pata_sht);
3db691daa   Florian Fainelli   [libata] Add supp...
163
164
165
166
167
168
169
170
171
172
  	if (ret)
  		goto err_free_gpio;
  
  	return 0;
  
  err_free_gpio:
  	gpio_free(gpio);
  
  	return ret;
  }
3dd654bfd   Ralf Baechle   [MIPS] ATA: Renam...
173
  static __devexit int rb532_pata_driver_remove(struct platform_device *pdev)
3db691daa   Florian Fainelli   [libata] Add supp...
174
175
  {
  	struct ata_host *ah = platform_get_drvdata(pdev);
3dd654bfd   Ralf Baechle   [MIPS] ATA: Renam...
176
  	struct rb532_cf_info *info = ah->private_data;
3db691daa   Florian Fainelli   [libata] Add supp...
177
178
179
180
181
182
  
  	ata_host_detach(ah);
  	gpio_free(info->gpio_line);
  
  	return 0;
  }
3dd654bfd   Ralf Baechle   [MIPS] ATA: Renam...
183
184
185
  static struct platform_driver rb532_pata_platform_driver = {
  	.probe		= rb532_pata_driver_probe,
  	.remove		= __devexit_p(rb532_pata_driver_remove),
3db691daa   Florian Fainelli   [libata] Add supp...
186
187
188
189
190
  	.driver	 = {
  		.name   = DRV_NAME,
  		.owner  = THIS_MODULE,
  	},
  };
3db691daa   Florian Fainelli   [libata] Add supp...
191
  #define DRV_INFO DRV_DESC " version " DRV_VERSION
99c8ea3e5   Axel Lin   SATA/PATA: conver...
192
  module_platform_driver(rb532_pata_platform_driver);
3db691daa   Florian Fainelli   [libata] Add supp...
193
194
195
196
197
198
  
  MODULE_AUTHOR("Gabor Juhos <juhosg at openwrt.org>");
  MODULE_AUTHOR("Florian Fainelli <florian@openwrt.org>");
  MODULE_DESCRIPTION(DRV_DESC);
  MODULE_VERSION(DRV_VERSION);
  MODULE_LICENSE("GPL");
99c8ea3e5   Axel Lin   SATA/PATA: conver...
199
  MODULE_ALIAS("platform:" DRV_NAME);