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#include <linux/types.h>
27#include <linux/module.h>
28#include <linux/kernel.h>
29#include <linux/ioport.h>
30#include <linux/ide.h>
31#include <linux/delay.h>
32#include <linux/init.h>
33#include <linux/clk.h>
34#include <linux/platform_device.h>
35
36
37#define IDE_PALM_ATA_PRI_REG_OFFSET 0x1F0
38
39
40#define IDE_PALM_ATA_PRI_CTL_OFFSET 0x3F6
41
42
43
44
45struct palm_bk3710_udmatiming {
46 unsigned int rptime;
47 unsigned int cycletime;
48};
49
50#define BK3710_BMICP 0x00
51#define BK3710_BMISP 0x02
52#define BK3710_BMIDTP 0x04
53#define BK3710_BMICS 0x08
54#define BK3710_BMISS 0x0A
55#define BK3710_BMIDTS 0x0C
56#define BK3710_IDETIMP 0x40
57#define BK3710_IDETIMS 0x42
58#define BK3710_SIDETIM 0x44
59#define BK3710_SLEWCTL 0x45
60#define BK3710_IDESTATUS 0x47
61#define BK3710_UDMACTL 0x48
62#define BK3710_UDMATIM 0x4A
63#define BK3710_MISCCTL 0x50
64#define BK3710_REGSTB 0x54
65#define BK3710_REGRCVR 0x58
66#define BK3710_DATSTB 0x5C
67#define BK3710_DATRCVR 0x60
68#define BK3710_DMASTB 0x64
69#define BK3710_DMARCVR 0x68
70#define BK3710_UDMASTB 0x6C
71#define BK3710_UDMATRP 0x70
72#define BK3710_UDMAENV 0x74
73#define BK3710_IORDYTMP 0x78
74#define BK3710_IORDYTMS 0x7C
75
76static unsigned ideclk_period;
77
78static const struct palm_bk3710_udmatiming palm_bk3710_udmatimings[6] = {
79 {160, 240},
80 {125, 160},
81 {100, 120},
82 {100, 90},
83 {100, 60},
84 {85, 40},
85};
86
87static void palm_bk3710_setudmamode(void __iomem *base, unsigned int dev,
88 unsigned int mode)
89{
90 u8 tenv, trp, t0;
91 u32 val32;
92 u16 val16;
93
94
95 t0 = DIV_ROUND_UP(palm_bk3710_udmatimings[mode].cycletime,
96 ideclk_period) - 1;
97 tenv = DIV_ROUND_UP(20, ideclk_period) - 1;
98 trp = DIV_ROUND_UP(palm_bk3710_udmatimings[mode].rptime,
99 ideclk_period) - 1;
100
101
102 val16 = readw(base + BK3710_UDMATIM) & (dev ? 0xFF0F : 0xFFF0);
103 val16 |= (mode << (dev ? 4 : 0));
104 writew(val16, base + BK3710_UDMATIM);
105
106
107 val32 = readl(base + BK3710_UDMASTB) & (0xFF << (dev ? 0 : 8));
108 val32 |= (t0 << (dev ? 8 : 0));
109 writel(val32, base + BK3710_UDMASTB);
110
111
112 val32 = readl(base + BK3710_UDMATRP) & (0xFF << (dev ? 0 : 8));
113 val32 |= (trp << (dev ? 8 : 0));
114 writel(val32, base + BK3710_UDMATRP);
115
116
117 val32 = readl(base + BK3710_UDMAENV) & (0xFF << (dev ? 0 : 8));
118 val32 |= (tenv << (dev ? 8 : 0));
119 writel(val32, base + BK3710_UDMAENV);
120
121
122 val16 = readw(base + BK3710_UDMACTL) | (1 << dev);
123 writew(val16, base + BK3710_UDMACTL);
124}
125
126static void palm_bk3710_setdmamode(void __iomem *base, unsigned int dev,
127 unsigned short min_cycle,
128 unsigned int mode)
129{
130 u8 td, tkw, t0;
131 u32 val32;
132 u16 val16;
133 struct ide_timing *t;
134 int cycletime;
135
136 t = ide_timing_find_mode(mode);
137 cycletime = max_t(int, t->cycle, min_cycle);
138
139
140 t0 = DIV_ROUND_UP(cycletime, ideclk_period);
141 td = DIV_ROUND_UP(t->active, ideclk_period);
142 tkw = t0 - td - 1;
143 td -= 1;
144
145 val32 = readl(base + BK3710_DMASTB) & (0xFF << (dev ? 0 : 8));
146 val32 |= (td << (dev ? 8 : 0));
147 writel(val32, base + BK3710_DMASTB);
148
149 val32 = readl(base + BK3710_DMARCVR) & (0xFF << (dev ? 0 : 8));
150 val32 |= (tkw << (dev ? 8 : 0));
151 writel(val32, base + BK3710_DMARCVR);
152
153
154 val16 = readw(base + BK3710_UDMACTL) & ~(1 << dev);
155 writew(val16, base + BK3710_UDMACTL);
156}
157
158static void palm_bk3710_setpiomode(void __iomem *base, ide_drive_t *mate,
159 unsigned int dev, unsigned int cycletime,
160 unsigned int mode)
161{
162 u8 t2, t2i, t0;
163 u32 val32;
164 struct ide_timing *t;
165
166
167 t0 = DIV_ROUND_UP(cycletime, ideclk_period);
168 t2 = DIV_ROUND_UP(ide_timing_find_mode(XFER_PIO_0 + mode)->active,
169 ideclk_period);
170
171 t2i = t0 - t2 - 1;
172 t2 -= 1;
173
174 val32 = readl(base + BK3710_DATSTB) & (0xFF << (dev ? 0 : 8));
175 val32 |= (t2 << (dev ? 8 : 0));
176 writel(val32, base + BK3710_DATSTB);
177
178 val32 = readl(base + BK3710_DATRCVR) & (0xFF << (dev ? 0 : 8));
179 val32 |= (t2i << (dev ? 8 : 0));
180 writel(val32, base + BK3710_DATRCVR);
181
182 if (mate) {
183 u8 mode2 = ide_get_best_pio_mode(mate, 255, 4);
184
185 if (mode2 < mode)
186 mode = mode2;
187 }
188
189
190 t = ide_timing_find_mode(XFER_PIO_0 + mode);
191 t0 = DIV_ROUND_UP(t->cyc8b, ideclk_period);
192 t2 = DIV_ROUND_UP(t->act8b, ideclk_period);
193
194 t2i = t0 - t2 - 1;
195 t2 -= 1;
196
197 val32 = readl(base + BK3710_REGSTB) & (0xFF << (dev ? 0 : 8));
198 val32 |= (t2 << (dev ? 8 : 0));
199 writel(val32, base + BK3710_REGSTB);
200
201 val32 = readl(base + BK3710_REGRCVR) & (0xFF << (dev ? 0 : 8));
202 val32 |= (t2i << (dev ? 8 : 0));
203 writel(val32, base + BK3710_REGRCVR);
204}
205
206static void palm_bk3710_set_dma_mode(ide_drive_t *drive, u8 xferspeed)
207{
208 int is_slave = drive->dn & 1;
209 void __iomem *base = (void *)drive->hwif->dma_base;
210
211 if (xferspeed >= XFER_UDMA_0) {
212 palm_bk3710_setudmamode(base, is_slave,
213 xferspeed - XFER_UDMA_0);
214 } else {
215 palm_bk3710_setdmamode(base, is_slave,
216 drive->id[ATA_ID_EIDE_DMA_MIN],
217 xferspeed);
218 }
219}
220
221static void palm_bk3710_set_pio_mode(ide_drive_t *drive, u8 pio)
222{
223 unsigned int cycle_time;
224 int is_slave = drive->dn & 1;
225 ide_drive_t *mate;
226 void __iomem *base = (void *)drive->hwif->dma_base;
227
228
229
230
231 cycle_time = ide_pio_cycle_time(drive, pio);
232 mate = ide_get_pair_dev(drive);
233 palm_bk3710_setpiomode(base, mate, is_slave, cycle_time, pio);
234}
235
236static void __devinit palm_bk3710_chipinit(void __iomem *base)
237{
238
239
240
241
242
243 writel(0x0300, base + BK3710_MISCCTL);
244
245
246 mdelay(100);
247
248
249 writel(0x0200, base + BK3710_MISCCTL);
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267 writew(0xB388, base + BK3710_IDETIMP);
268
269
270
271
272
273
274 writeb(0, base + BK3710_SIDETIM);
275
276
277
278
279
280
281
282 writew(0, base + BK3710_UDMACTL);
283
284
285
286
287
288
289
290 writel(0x201, base + BK3710_MISCCTL);
291
292
293
294
295
296 writel(0xFFFF, base + BK3710_IORDYTMP);
297
298
299
300
301
302
303
304
305
306 writew(0, base + BK3710_BMISP);
307
308 palm_bk3710_setpiomode(base, NULL, 0, 600, 0);
309 palm_bk3710_setpiomode(base, NULL, 1, 600, 0);
310}
311
312static u8 palm_bk3710_cable_detect(ide_hwif_t *hwif)
313{
314 return ATA_CBL_PATA80;
315}
316
317static int __devinit palm_bk3710_init_dma(ide_hwif_t *hwif,
318 const struct ide_port_info *d)
319{
320 printk(KERN_INFO " %s: MMIO-DMA\n", hwif->name);
321
322 if (ide_allocate_dma_engine(hwif))
323 return -1;
324
325 hwif->dma_base = hwif->io_ports.data_addr - IDE_PALM_ATA_PRI_REG_OFFSET;
326
327 hwif->dma_ops = &sff_dma_ops;
328
329 return 0;
330}
331
332static const struct ide_port_ops palm_bk3710_ports_ops = {
333 .set_pio_mode = palm_bk3710_set_pio_mode,
334 .set_dma_mode = palm_bk3710_set_dma_mode,
335 .cable_detect = palm_bk3710_cable_detect,
336};
337
338static struct ide_port_info __devinitdata palm_bk3710_port_info = {
339 .init_dma = palm_bk3710_init_dma,
340 .port_ops = &palm_bk3710_ports_ops,
341 .host_flags = IDE_HFLAG_MMIO,
342 .pio_mask = ATA_PIO4,
343 .mwdma_mask = ATA_MWDMA2,
344};
345
346static int __init palm_bk3710_probe(struct platform_device *pdev)
347{
348 struct clk *clk;
349 struct resource *mem, *irq;
350 unsigned long base, rate;
351 int i, rc;
352 hw_regs_t hw, *hws[] = { &hw, NULL, NULL, NULL };
353
354 clk = clk_get(&pdev->dev, "IDECLK");
355 if (IS_ERR(clk))
356 return -ENODEV;
357
358 clk_enable(clk);
359 rate = clk_get_rate(clk);
360 ideclk_period = 1000000000UL / rate;
361
362
363 memset(&hw, 0, sizeof(hw));
364
365 mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
366 if (mem == NULL) {
367 printk(KERN_ERR "failed to get memory region resource\n");
368 return -ENODEV;
369 }
370
371 irq = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
372 if (irq == NULL) {
373 printk(KERN_ERR "failed to get IRQ resource\n");
374 return -ENODEV;
375 }
376
377 if (request_mem_region(mem->start, mem->end - mem->start + 1,
378 "palm_bk3710") == NULL) {
379 printk(KERN_ERR "failed to request memory region\n");
380 return -EBUSY;
381 }
382
383 base = IO_ADDRESS(mem->start);
384
385
386 palm_bk3710_chipinit((void __iomem *)base);
387
388 for (i = 0; i < IDE_NR_PORTS - 2; i++)
389 hw.io_ports_array[i] = base + IDE_PALM_ATA_PRI_REG_OFFSET + i;
390 hw.io_ports.ctl_addr = base + IDE_PALM_ATA_PRI_CTL_OFFSET;
391 hw.irq = irq->start;
392 hw.dev = &pdev->dev;
393 hw.chipset = ide_palm3710;
394
395 palm_bk3710_port_info.udma_mask = rate < 100000000 ? ATA_UDMA4 :
396 ATA_UDMA5;
397
398 rc = ide_host_add(&palm_bk3710_port_info, hws, NULL);
399 if (rc)
400 goto out;
401
402 return 0;
403out:
404 printk(KERN_WARNING "Palm Chip BK3710 IDE Register Fail\n");
405 return rc;
406}
407
408
409MODULE_ALIAS("platform:palm_bk3710");
410
411static struct platform_driver platform_bk_driver = {
412 .driver = {
413 .name = "palm_bk3710",
414 .owner = THIS_MODULE,
415 },
416};
417
418static int __init palm_bk3710_init(void)
419{
420 return platform_driver_probe(&platform_bk_driver, palm_bk3710_probe);
421}
422
423module_init(palm_bk3710_init);
424MODULE_LICENSE("GPL");
425