Root/
1 | /* |
2 | * ixp4xx PATA/Compact Flash driver |
3 | * Copyright (C) 2006-07 Tower Technologies |
4 | * Author: Alessandro Zummo <a.zummo@towertech.it> |
5 | * |
6 | * An ATA driver to handle a Compact Flash connected |
7 | * to the ixp4xx expansion bus in TrueIDE mode. The CF |
8 | * must have it chip selects connected to two CS lines |
9 | * on the ixp4xx. In the irq is not available, you might |
10 | * want to modify both this driver and libata to run in |
11 | * polling mode. |
12 | * |
13 | * This program is free software; you can redistribute it and/or modify |
14 | * it under the terms of the GNU General Public License version 2 as |
15 | * published by the Free Software Foundation. |
16 | * |
17 | */ |
18 | |
19 | #include <linux/kernel.h> |
20 | #include <linux/module.h> |
21 | #include <linux/libata.h> |
22 | #include <linux/irq.h> |
23 | #include <linux/platform_device.h> |
24 | #include <scsi/scsi_host.h> |
25 | |
26 | #define DRV_NAME "pata_ixp4xx_cf" |
27 | #define DRV_VERSION "0.2" |
28 | |
29 | static int ixp4xx_set_mode(struct ata_link *link, struct ata_device **error) |
30 | { |
31 | struct ata_device *dev; |
32 | |
33 | ata_for_each_dev(dev, link, ENABLED) { |
34 | ata_dev_info(dev, "configured for PIO0\n"); |
35 | dev->pio_mode = XFER_PIO_0; |
36 | dev->xfer_mode = XFER_PIO_0; |
37 | dev->xfer_shift = ATA_SHIFT_PIO; |
38 | dev->flags |= ATA_DFLAG_PIO; |
39 | } |
40 | return 0; |
41 | } |
42 | |
43 | static unsigned int ixp4xx_mmio_data_xfer(struct ata_device *dev, |
44 | unsigned char *buf, unsigned int buflen, int rw) |
45 | { |
46 | unsigned int i; |
47 | unsigned int words = buflen >> 1; |
48 | u16 *buf16 = (u16 *) buf; |
49 | struct ata_port *ap = dev->link->ap; |
50 | void __iomem *mmio = ap->ioaddr.data_addr; |
51 | struct ixp4xx_pata_data *data = ap->host->dev->platform_data; |
52 | |
53 | /* set the expansion bus in 16bit mode and restore |
54 | * 8 bit mode after the transaction. |
55 | */ |
56 | *data->cs0_cfg &= ~(0x01); |
57 | udelay(100); |
58 | |
59 | /* Transfer multiple of 2 bytes */ |
60 | if (rw == READ) |
61 | for (i = 0; i < words; i++) |
62 | buf16[i] = readw(mmio); |
63 | else |
64 | for (i = 0; i < words; i++) |
65 | writew(buf16[i], mmio); |
66 | |
67 | /* Transfer trailing 1 byte, if any. */ |
68 | if (unlikely(buflen & 0x01)) { |
69 | u16 align_buf[1] = { 0 }; |
70 | unsigned char *trailing_buf = buf + buflen - 1; |
71 | |
72 | if (rw == READ) { |
73 | align_buf[0] = readw(mmio); |
74 | memcpy(trailing_buf, align_buf, 1); |
75 | } else { |
76 | memcpy(align_buf, trailing_buf, 1); |
77 | writew(align_buf[0], mmio); |
78 | } |
79 | words++; |
80 | } |
81 | |
82 | udelay(100); |
83 | *data->cs0_cfg |= 0x01; |
84 | |
85 | return words << 1; |
86 | } |
87 | |
88 | static struct scsi_host_template ixp4xx_sht = { |
89 | ATA_PIO_SHT(DRV_NAME), |
90 | }; |
91 | |
92 | static struct ata_port_operations ixp4xx_port_ops = { |
93 | .inherits = &ata_sff_port_ops, |
94 | .sff_data_xfer = ixp4xx_mmio_data_xfer, |
95 | .cable_detect = ata_cable_40wire, |
96 | .set_mode = ixp4xx_set_mode, |
97 | }; |
98 | |
99 | static void ixp4xx_setup_port(struct ata_port *ap, |
100 | struct ixp4xx_pata_data *data, |
101 | unsigned long raw_cs0, unsigned long raw_cs1) |
102 | { |
103 | struct ata_ioports *ioaddr = &ap->ioaddr; |
104 | unsigned long raw_cmd = raw_cs0; |
105 | unsigned long raw_ctl = raw_cs1 + 0x06; |
106 | |
107 | ioaddr->cmd_addr = data->cs0; |
108 | ioaddr->altstatus_addr = data->cs1 + 0x06; |
109 | ioaddr->ctl_addr = data->cs1 + 0x06; |
110 | |
111 | ata_sff_std_ports(ioaddr); |
112 | |
113 | #ifndef __ARMEB__ |
114 | |
115 | /* adjust the addresses to handle the address swizzling of the |
116 | * ixp4xx in little endian mode. |
117 | */ |
118 | |
119 | *(unsigned long *)&ioaddr->data_addr ^= 0x02; |
120 | *(unsigned long *)&ioaddr->cmd_addr ^= 0x03; |
121 | *(unsigned long *)&ioaddr->altstatus_addr ^= 0x03; |
122 | *(unsigned long *)&ioaddr->ctl_addr ^= 0x03; |
123 | *(unsigned long *)&ioaddr->error_addr ^= 0x03; |
124 | *(unsigned long *)&ioaddr->feature_addr ^= 0x03; |
125 | *(unsigned long *)&ioaddr->nsect_addr ^= 0x03; |
126 | *(unsigned long *)&ioaddr->lbal_addr ^= 0x03; |
127 | *(unsigned long *)&ioaddr->lbam_addr ^= 0x03; |
128 | *(unsigned long *)&ioaddr->lbah_addr ^= 0x03; |
129 | *(unsigned long *)&ioaddr->device_addr ^= 0x03; |
130 | *(unsigned long *)&ioaddr->status_addr ^= 0x03; |
131 | *(unsigned long *)&ioaddr->command_addr ^= 0x03; |
132 | |
133 | raw_cmd ^= 0x03; |
134 | raw_ctl ^= 0x03; |
135 | #endif |
136 | |
137 | ata_port_desc(ap, "cmd 0x%lx ctl 0x%lx", raw_cmd, raw_ctl); |
138 | } |
139 | |
140 | static __devinit int ixp4xx_pata_probe(struct platform_device *pdev) |
141 | { |
142 | unsigned int irq; |
143 | struct resource *cs0, *cs1; |
144 | struct ata_host *host; |
145 | struct ata_port *ap; |
146 | struct ixp4xx_pata_data *data = pdev->dev.platform_data; |
147 | |
148 | cs0 = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
149 | cs1 = platform_get_resource(pdev, IORESOURCE_MEM, 1); |
150 | |
151 | if (!cs0 || !cs1) |
152 | return -EINVAL; |
153 | |
154 | /* allocate host */ |
155 | host = ata_host_alloc(&pdev->dev, 1); |
156 | if (!host) |
157 | return -ENOMEM; |
158 | |
159 | /* acquire resources and fill host */ |
160 | pdev->dev.coherent_dma_mask = DMA_BIT_MASK(32); |
161 | |
162 | data->cs0 = devm_ioremap(&pdev->dev, cs0->start, 0x1000); |
163 | data->cs1 = devm_ioremap(&pdev->dev, cs1->start, 0x1000); |
164 | |
165 | if (!data->cs0 || !data->cs1) |
166 | return -ENOMEM; |
167 | |
168 | irq = platform_get_irq(pdev, 0); |
169 | if (irq) |
170 | irq_set_irq_type(irq, IRQ_TYPE_EDGE_RISING); |
171 | |
172 | /* Setup expansion bus chip selects */ |
173 | *data->cs0_cfg = data->cs0_bits; |
174 | *data->cs1_cfg = data->cs1_bits; |
175 | |
176 | ap = host->ports[0]; |
177 | |
178 | ap->ops = &ixp4xx_port_ops; |
179 | ap->pio_mask = ATA_PIO4; |
180 | ap->flags |= ATA_FLAG_NO_ATAPI; |
181 | |
182 | ixp4xx_setup_port(ap, data, cs0->start, cs1->start); |
183 | |
184 | ata_print_version_once(&pdev->dev, DRV_VERSION); |
185 | |
186 | /* activate host */ |
187 | return ata_host_activate(host, irq, ata_sff_interrupt, 0, &ixp4xx_sht); |
188 | } |
189 | |
190 | static __devexit int ixp4xx_pata_remove(struct platform_device *dev) |
191 | { |
192 | struct ata_host *host = platform_get_drvdata(dev); |
193 | |
194 | ata_host_detach(host); |
195 | |
196 | return 0; |
197 | } |
198 | |
199 | static struct platform_driver ixp4xx_pata_platform_driver = { |
200 | .driver = { |
201 | .name = DRV_NAME, |
202 | .owner = THIS_MODULE, |
203 | }, |
204 | .probe = ixp4xx_pata_probe, |
205 | .remove = __devexit_p(ixp4xx_pata_remove), |
206 | }; |
207 | |
208 | module_platform_driver(ixp4xx_pata_platform_driver); |
209 | |
210 | MODULE_AUTHOR("Alessandro Zummo <a.zummo@towertech.it>"); |
211 | MODULE_DESCRIPTION("low-level driver for ixp4xx Compact Flash PATA"); |
212 | MODULE_LICENSE("GPL"); |
213 | MODULE_VERSION(DRV_VERSION); |
214 | MODULE_ALIAS("platform:" DRV_NAME); |
215 |
Branches:
ben-wpan
ben-wpan-stefan
javiroman/ks7010
jz-2.6.34
jz-2.6.34-rc5
jz-2.6.34-rc6
jz-2.6.34-rc7
jz-2.6.35
jz-2.6.36
jz-2.6.37
jz-2.6.38
jz-2.6.39
jz-3.0
jz-3.1
jz-3.11
jz-3.12
jz-3.13
jz-3.15
jz-3.16
jz-3.18-dt
jz-3.2
jz-3.3
jz-3.4
jz-3.5
jz-3.6
jz-3.6-rc2-pwm
jz-3.9
jz-3.9-clk
jz-3.9-rc8
jz47xx
jz47xx-2.6.38
master
Tags:
od-2011-09-04
od-2011-09-18
v2.6.34-rc5
v2.6.34-rc6
v2.6.34-rc7
v3.9