1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38#include <linux/module.h>
39#include <linux/types.h>
40#include <linux/kernel.h>
41#include <linux/delay.h>
42#include <linux/timer.h>
43#include <linux/mm.h>
44#include <linux/ioport.h>
45#include <linux/blkdev.h>
46#include <linux/ide.h>
47#include <linux/init.h>
48
49#include <asm/io.h>
50
51#define DRV_NAME "ali14xx"
52
53
54#define ALI_NUM_PORTS 4
55static const int ports[ALI_NUM_PORTS] __initconst =
56 { 0x074, 0x0f4, 0x034, 0x0e4 };
57
58
59typedef struct { u8 reg, data; } RegInitializer;
60
61static const RegInitializer initData[] __initconst = {
62 {0x01, 0x0f}, {0x02, 0x00}, {0x03, 0x00}, {0x04, 0x00},
63 {0x05, 0x00}, {0x06, 0x00}, {0x07, 0x2b}, {0x0a, 0x0f},
64 {0x25, 0x00}, {0x26, 0x00}, {0x27, 0x00}, {0x28, 0x00},
65 {0x29, 0x00}, {0x2a, 0x00}, {0x2f, 0x00}, {0x2b, 0x00},
66 {0x2c, 0x00}, {0x2d, 0x00}, {0x2e, 0x00}, {0x30, 0x00},
67 {0x31, 0x00}, {0x32, 0x00}, {0x33, 0x00}, {0x34, 0xff},
68 {0x35, 0x03}, {0x00, 0x00}
69};
70
71
72static struct { u8 reg1, reg2, reg3, reg4; } regTab[4] = {
73 {0x03, 0x26, 0x04, 0x27},
74 {0x05, 0x28, 0x06, 0x29},
75 {0x2b, 0x30, 0x2c, 0x31},
76 {0x2d, 0x32, 0x2e, 0x33},
77};
78
79static int basePort;
80static int regPort;
81static int dataPort;
82static u8 regOn;
83static u8 regOff;
84
85
86
87
88
89
90static inline u8 inReg(u8 reg)
91{
92 outb_p(reg, regPort);
93 return inb(dataPort);
94}
95
96
97
98
99static void outReg(u8 data, u8 reg)
100{
101 outb_p(reg, regPort);
102 outb_p(data, dataPort);
103}
104
105static DEFINE_SPINLOCK(ali14xx_lock);
106
107
108
109
110
111
112static void ali14xx_set_pio_mode(ide_hwif_t *hwif, ide_drive_t *drive)
113{
114 int driveNum;
115 int time1, time2;
116 u8 param1, param2, param3, param4;
117 unsigned long flags;
118 int bus_speed = ide_vlb_clk ? ide_vlb_clk : 50;
119 const u8 pio = drive->pio_mode - XFER_PIO_0;
120 struct ide_timing *t = ide_timing_find_mode(XFER_PIO_0 + pio);
121
122
123 time1 = ide_pio_cycle_time(drive, pio);
124 time2 = t->active;
125 param3 = param1 = (time2 * bus_speed + 999) / 1000;
126 param4 = param2 = (time1 * bus_speed + 999) / 1000 - param1;
127 if (pio < 3) {
128 param3 += 8;
129 param4 += 8;
130 }
131 printk(KERN_DEBUG "%s: PIO mode%d, t1=%dns, t2=%dns, cycles = %d+%d, %d+%d\n",
132 drive->name, pio, time1, time2, param1, param2, param3, param4);
133
134
135 driveNum = (drive->hwif->index << 1) + (drive->dn & 1);
136 spin_lock_irqsave(&ali14xx_lock, flags);
137 outb_p(regOn, basePort);
138 outReg(param1, regTab[driveNum].reg1);
139 outReg(param2, regTab[driveNum].reg2);
140 outReg(param3, regTab[driveNum].reg3);
141 outReg(param4, regTab[driveNum].reg4);
142 outb_p(regOff, basePort);
143 spin_unlock_irqrestore(&ali14xx_lock, flags);
144}
145
146
147
148
149static int __init findPort(void)
150{
151 int i;
152 u8 t;
153 unsigned long flags;
154
155 local_irq_save(flags);
156 for (i = 0; i < ALI_NUM_PORTS; ++i) {
157 basePort = ports[i];
158 regOff = inb(basePort);
159 for (regOn = 0x30; regOn <= 0x33; ++regOn) {
160 outb_p(regOn, basePort);
161 if (inb(basePort) == regOn) {
162 regPort = basePort + 4;
163 dataPort = basePort + 8;
164 t = inReg(0) & 0xf0;
165 outb_p(regOff, basePort);
166 local_irq_restore(flags);
167 if (t != 0x50)
168 return 0;
169 return 1;
170 }
171 }
172 outb_p(regOff, basePort);
173 }
174 local_irq_restore(flags);
175 return 0;
176}
177
178
179
180
181static int __init initRegisters(void)
182{
183 const RegInitializer *p;
184 u8 t;
185 unsigned long flags;
186
187 local_irq_save(flags);
188 outb_p(regOn, basePort);
189 for (p = initData; p->reg != 0; ++p)
190 outReg(p->data, p->reg);
191 outb_p(0x01, regPort);
192 t = inb(regPort) & 0x01;
193 outb_p(regOff, basePort);
194 local_irq_restore(flags);
195 return t;
196}
197
198static const struct ide_port_ops ali14xx_port_ops = {
199 .set_pio_mode = ali14xx_set_pio_mode,
200};
201
202static const struct ide_port_info ali14xx_port_info = {
203 .name = DRV_NAME,
204 .chipset = ide_ali14xx,
205 .port_ops = &ali14xx_port_ops,
206 .host_flags = IDE_HFLAG_NO_DMA,
207 .pio_mask = ATA_PIO4,
208};
209
210static int __init ali14xx_probe(void)
211{
212 printk(KERN_DEBUG "ali14xx: base=0x%03x, regOn=0x%02x.\n",
213 basePort, regOn);
214
215
216 if (!initRegisters()) {
217 printk(KERN_ERR "ali14xx: Chip initialization failed.\n");
218 return 1;
219 }
220
221 return ide_legacy_device_add(&ali14xx_port_info, 0);
222}
223
224static bool probe_ali14xx;
225
226module_param_named(probe, probe_ali14xx, bool, 0);
227MODULE_PARM_DESC(probe, "probe for ALI M14xx chipsets");
228
229static int __init ali14xx_init(void)
230{
231 if (probe_ali14xx == 0)
232 goto out;
233
234
235 if (findPort()) {
236 if (ali14xx_probe())
237 return -ENODEV;
238 return 0;
239 }
240 printk(KERN_ERR "ali14xx: not found.\n");
241out:
242 return -ENODEV;
243}
244
245module_init(ali14xx_init);
246
247MODULE_AUTHOR("see local file");
248MODULE_DESCRIPTION("support of ALI 14XX IDE chipsets");
249MODULE_LICENSE("GPL");
250