palm_bk3710: fix ide_unregister() usage
[linux-2.6/kvm.git] / drivers / ide / arm / palm_bk3710.c
blob0ce95c1ba7e1dd7356d85294ec3ff3acab227d18
1 /*
2 * Palmchip bk3710 IDE controller
4 * Copyright (C) 2006 Texas Instruments.
5 * Copyright (C) 2007 MontaVista Software, Inc., <source@mvista.com>
7 * ----------------------------------------------------------------------------
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License as published by
11 * the Free Software Foundation; either version 2 of the License, or
12 * (at your option) any later version.
14 * This program is distributed in the hope that it will be useful,
15 * but WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
17 * GNU General Public License for more details.
19 * You should have received a copy of the GNU General Public License
20 * along with this program; if not, write to the Free Software
21 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
22 * ----------------------------------------------------------------------------
26 #include <linux/types.h>
27 #include <linux/module.h>
28 #include <linux/kernel.h>
29 #include <linux/ioport.h>
30 #include <linux/hdreg.h>
31 #include <linux/ide.h>
32 #include <linux/delay.h>
33 #include <linux/init.h>
34 #include <linux/clk.h>
35 #include <linux/platform_device.h>
37 /* Offset of the primary interface registers */
38 #define IDE_PALM_ATA_PRI_REG_OFFSET 0x1F0
40 /* Primary Control Offset */
41 #define IDE_PALM_ATA_PRI_CTL_OFFSET 0x3F6
44 * PalmChip 3710 IDE Controller UDMA timing structure Definition
46 struct palm_bk3710_udmatiming {
47 unsigned int rptime; /* Ready to pause time */
48 unsigned int cycletime; /* Cycle Time */
51 #define BK3710_BMICP 0x00
52 #define BK3710_BMISP 0x02
53 #define BK3710_BMIDTP 0x04
54 #define BK3710_BMICS 0x08
55 #define BK3710_BMISS 0x0A
56 #define BK3710_BMIDTS 0x0C
57 #define BK3710_IDETIMP 0x40
58 #define BK3710_IDETIMS 0x42
59 #define BK3710_SIDETIM 0x44
60 #define BK3710_SLEWCTL 0x45
61 #define BK3710_IDESTATUS 0x47
62 #define BK3710_UDMACTL 0x48
63 #define BK3710_UDMATIM 0x4A
64 #define BK3710_MISCCTL 0x50
65 #define BK3710_REGSTB 0x54
66 #define BK3710_REGRCVR 0x58
67 #define BK3710_DATSTB 0x5C
68 #define BK3710_DATRCVR 0x60
69 #define BK3710_DMASTB 0x64
70 #define BK3710_DMARCVR 0x68
71 #define BK3710_UDMASTB 0x6C
72 #define BK3710_UDMATRP 0x70
73 #define BK3710_UDMAENV 0x74
74 #define BK3710_IORDYTMP 0x78
75 #define BK3710_IORDYTMS 0x7C
77 #include "../ide-timing.h"
79 static long ide_palm_clk;
81 static const struct palm_bk3710_udmatiming palm_bk3710_udmatimings[6] = {
82 {160, 240}, /* UDMA Mode 0 */
83 {125, 160}, /* UDMA Mode 1 */
84 {100, 120}, /* UDMA Mode 2 */
85 {100, 90}, /* UDMA Mode 3 */
86 {85, 60}, /* UDMA Mode 4 */
89 static struct clk *ideclkp;
91 static void palm_bk3710_setudmamode(void __iomem *base, unsigned int dev,
92 unsigned int mode)
94 u8 tenv, trp, t0;
95 u32 val32;
96 u16 val16;
98 /* DMA Data Setup */
99 t0 = (palm_bk3710_udmatimings[mode].cycletime + ide_palm_clk - 1)
100 / ide_palm_clk - 1;
101 tenv = (20 + ide_palm_clk - 1) / ide_palm_clk - 1;
102 trp = (palm_bk3710_udmatimings[mode].rptime + ide_palm_clk - 1)
103 / ide_palm_clk - 1;
105 /* udmatim Register */
106 val16 = readw(base + BK3710_UDMATIM) & (dev ? 0xFF0F : 0xFFF0);
107 val16 |= (mode << (dev ? 4 : 0));
108 writew(val16, base + BK3710_UDMATIM);
110 /* udmastb Ultra DMA Access Strobe Width */
111 val32 = readl(base + BK3710_UDMASTB) & (0xFF << (dev ? 0 : 8));
112 val32 |= (t0 << (dev ? 8 : 0));
113 writel(val32, base + BK3710_UDMASTB);
115 /* udmatrp Ultra DMA Ready to Pause Time */
116 val32 = readl(base + BK3710_UDMATRP) & (0xFF << (dev ? 0 : 8));
117 val32 |= (trp << (dev ? 8 : 0));
118 writel(val32, base + BK3710_UDMATRP);
120 /* udmaenv Ultra DMA envelop Time */
121 val32 = readl(base + BK3710_UDMAENV) & (0xFF << (dev ? 0 : 8));
122 val32 |= (tenv << (dev ? 8 : 0));
123 writel(val32, base + BK3710_UDMAENV);
125 /* Enable UDMA for Device */
126 val16 = readw(base + BK3710_UDMACTL) | (1 << dev);
127 writew(val16, base + BK3710_UDMACTL);
130 static void palm_bk3710_setdmamode(void __iomem *base, unsigned int dev,
131 unsigned short min_cycle,
132 unsigned int mode)
134 u8 td, tkw, t0;
135 u32 val32;
136 u16 val16;
137 struct ide_timing *t;
138 int cycletime;
140 t = ide_timing_find_mode(mode);
141 cycletime = max_t(int, t->cycle, min_cycle);
143 /* DMA Data Setup */
144 t0 = (cycletime + ide_palm_clk - 1) / ide_palm_clk;
145 td = (t->active + ide_palm_clk - 1) / ide_palm_clk;
146 tkw = t0 - td - 1;
147 td -= 1;
149 val32 = readl(base + BK3710_DMASTB) & (0xFF << (dev ? 0 : 8));
150 val32 |= (td << (dev ? 8 : 0));
151 writel(val32, base + BK3710_DMASTB);
153 val32 = readl(base + BK3710_DMARCVR) & (0xFF << (dev ? 0 : 8));
154 val32 |= (tkw << (dev ? 8 : 0));
155 writel(val32, base + BK3710_DMARCVR);
157 /* Disable UDMA for Device */
158 val16 = readw(base + BK3710_UDMACTL) & ~(1 << dev);
159 writew(val16, base + BK3710_UDMACTL);
162 static void palm_bk3710_setpiomode(void __iomem *base, ide_drive_t *mate,
163 unsigned int dev, unsigned int cycletime,
164 unsigned int mode)
166 u8 t2, t2i, t0;
167 u32 val32;
168 struct ide_timing *t;
170 /* PIO Data Setup */
171 t0 = (cycletime + ide_palm_clk - 1) / ide_palm_clk;
172 t2 = (ide_timing_find_mode(XFER_PIO_0 + mode)->active +
173 ide_palm_clk - 1) / ide_palm_clk;
175 t2i = t0 - t2 - 1;
176 t2 -= 1;
178 val32 = readl(base + BK3710_DATSTB) & (0xFF << (dev ? 0 : 8));
179 val32 |= (t2 << (dev ? 8 : 0));
180 writel(val32, base + BK3710_DATSTB);
182 val32 = readl(base + BK3710_DATRCVR) & (0xFF << (dev ? 0 : 8));
183 val32 |= (t2i << (dev ? 8 : 0));
184 writel(val32, base + BK3710_DATRCVR);
186 if (mate && mate->present) {
187 u8 mode2 = ide_get_best_pio_mode(mate, 255, 4);
189 if (mode2 < mode)
190 mode = mode2;
193 /* TASKFILE Setup */
194 t = ide_timing_find_mode(XFER_PIO_0 + mode);
195 t0 = (t->cyc8b + ide_palm_clk - 1) / ide_palm_clk;
196 t2 = (t->act8b + ide_palm_clk - 1) / ide_palm_clk;
198 t2i = t0 - t2 - 1;
199 t2 -= 1;
201 val32 = readl(base + BK3710_REGSTB) & (0xFF << (dev ? 0 : 8));
202 val32 |= (t2 << (dev ? 8 : 0));
203 writel(val32, base + BK3710_REGSTB);
205 val32 = readl(base + BK3710_REGRCVR) & (0xFF << (dev ? 0 : 8));
206 val32 |= (t2i << (dev ? 8 : 0));
207 writel(val32, base + BK3710_REGRCVR);
210 static void palm_bk3710_set_dma_mode(ide_drive_t *drive, u8 xferspeed)
212 int is_slave = drive->dn & 1;
213 void __iomem *base = (void *)drive->hwif->dma_base;
215 if (xferspeed >= XFER_UDMA_0) {
216 palm_bk3710_setudmamode(base, is_slave,
217 xferspeed - XFER_UDMA_0);
218 } else {
219 palm_bk3710_setdmamode(base, is_slave, drive->id->eide_dma_min,
220 xferspeed);
224 static void palm_bk3710_set_pio_mode(ide_drive_t *drive, u8 pio)
226 unsigned int cycle_time;
227 int is_slave = drive->dn & 1;
228 ide_drive_t *mate;
229 void __iomem *base = (void *)drive->hwif->dma_base;
232 * Obtain the drive PIO data for tuning the Palm Chip registers
234 cycle_time = ide_pio_cycle_time(drive, pio);
235 mate = ide_get_paired_drive(drive);
236 palm_bk3710_setpiomode(base, mate, is_slave, cycle_time, pio);
239 static void __devinit palm_bk3710_chipinit(void __iomem *base)
242 * enable the reset_en of ATA controller so that when ata signals
243 * are brought out, by writing into device config. at that
244 * time por_n signal should not be 'Z' and have a stable value.
246 writel(0x0300, base + BK3710_MISCCTL);
248 /* wait for some time and deassert the reset of ATA Device. */
249 mdelay(100);
251 /* Deassert the Reset */
252 writel(0x0200, base + BK3710_MISCCTL);
255 * Program the IDETIMP Register Value based on the following assumptions
257 * (ATA_IDETIMP_IDEEN , ENABLE ) |
258 * (ATA_IDETIMP_SLVTIMEN , DISABLE) |
259 * (ATA_IDETIMP_RDYSMPL , 70NS) |
260 * (ATA_IDETIMP_RDYRCVRY , 50NS) |
261 * (ATA_IDETIMP_DMAFTIM1 , PIOCOMP) |
262 * (ATA_IDETIMP_PREPOST1 , DISABLE) |
263 * (ATA_IDETIMP_RDYSEN1 , DISABLE) |
264 * (ATA_IDETIMP_PIOFTIM1 , DISABLE) |
265 * (ATA_IDETIMP_DMAFTIM0 , PIOCOMP) |
266 * (ATA_IDETIMP_PREPOST0 , DISABLE) |
267 * (ATA_IDETIMP_RDYSEN0 , DISABLE) |
268 * (ATA_IDETIMP_PIOFTIM0 , DISABLE)
270 writew(0xB388, base + BK3710_IDETIMP);
273 * Configure SIDETIM Register
274 * (ATA_SIDETIM_RDYSMPS1 ,120NS ) |
275 * (ATA_SIDETIM_RDYRCYS1 ,120NS )
277 writeb(0, base + BK3710_SIDETIM);
280 * UDMACTL Ultra-ATA DMA Control
281 * (ATA_UDMACTL_UDMAP1 , 0 ) |
282 * (ATA_UDMACTL_UDMAP0 , 0 )
285 writew(0, base + BK3710_UDMACTL);
288 * MISCCTL Miscellaneous Conrol Register
289 * (ATA_MISCCTL_RSTMODEP , 1) |
290 * (ATA_MISCCTL_RESETP , 0) |
291 * (ATA_MISCCTL_TIMORIDE , 1)
293 writel(0x201, base + BK3710_MISCCTL);
296 * IORDYTMP IORDY Timer for Primary Register
297 * (ATA_IORDYTMP_IORDYTMP , 0xffff )
299 writel(0xFFFF, base + BK3710_IORDYTMP);
302 * Configure BMISP Register
303 * (ATA_BMISP_DMAEN1 , DISABLE ) |
304 * (ATA_BMISP_DMAEN0 , DISABLE ) |
305 * (ATA_BMISP_IORDYINT , CLEAR) |
306 * (ATA_BMISP_INTRSTAT , CLEAR) |
307 * (ATA_BMISP_DMAERROR , CLEAR)
309 writew(0, base + BK3710_BMISP);
311 palm_bk3710_setpiomode(base, NULL, 0, 600, 0);
312 palm_bk3710_setpiomode(base, NULL, 1, 600, 0);
314 static int __devinit palm_bk3710_probe(struct platform_device *pdev)
316 struct clk *clkp;
317 struct resource *mem, *irq;
318 ide_hwif_t *hwif;
319 void __iomem *base;
320 int pribase, i;
321 hw_regs_t hw;
322 u8 idx[4] = { 0xff, 0xff, 0xff, 0xff };
324 clkp = clk_get(NULL, "IDECLK");
325 if (IS_ERR(clkp))
326 return -ENODEV;
328 ideclkp = clkp;
329 clk_enable(ideclkp);
330 ide_palm_clk = clk_get_rate(ideclkp)/100000;
331 ide_palm_clk = (10000/ide_palm_clk) + 1;
332 /* Register the IDE interface with Linux ATA Interface */
333 memset(&hw, 0, sizeof(hw));
335 mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
336 if (mem == NULL) {
337 printk(KERN_ERR "failed to get memory region resource\n");
338 return -ENODEV;
340 irq = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
341 if (irq == NULL) {
342 printk(KERN_ERR "failed to get IRQ resource\n");
343 return -ENODEV;
346 base = (void *)mem->start;
348 /* Configure the Palm Chip controller */
349 palm_bk3710_chipinit(base);
351 pribase = mem->start + IDE_PALM_ATA_PRI_REG_OFFSET;
352 for (i = 0; i < IDE_NR_PORTS - 2; i++)
353 hw.io_ports[i] = pribase + i;
354 hw.io_ports[IDE_CONTROL_OFFSET] = mem->start +
355 IDE_PALM_ATA_PRI_CTL_OFFSET;
356 hw.irq = irq->start;
357 hw.chipset = ide_palm3710;
359 hwif = ide_deprecated_find_port(hw.io_ports[IDE_DATA_OFFSET]);
360 if (hwif == NULL)
361 goto out;
363 i = hwif->index;
365 if (hwif->present)
366 ide_unregister(i, 0, 0);
367 else if (!hwif->hold)
368 ide_init_port_data(hwif, i);
370 ide_init_port_hw(hwif, &hw);
371 hwif->quirkproc = NULL;
373 idx[0] = i;
375 ide_device_add(idx, NULL);
377 if (!hwif->present)
378 goto out;
380 hwif->set_pio_mode = &palm_bk3710_set_pio_mode;
381 hwif->set_dma_mode = &palm_bk3710_set_dma_mode;
382 hwif->mmio = 1;
383 default_hwif_mmiops(hwif);
384 hwif->cbl = ATA_CBL_PATA80;
385 hwif->ultra_mask = 0x1f; /* Ultra DMA Mode 4 Max
386 (input clk 99MHz) */
387 hwif->mwdma_mask = 0x7;
388 hwif->drives[0].autotune = 1;
389 hwif->drives[1].autotune = 1;
391 ide_setup_dma(hwif, mem->start);
393 return 0;
394 out:
395 printk(KERN_WARNING "Palm Chip BK3710 IDE Register Fail\n");
396 return -ENODEV;
399 static struct platform_driver platform_bk_driver = {
400 .driver = {
401 .name = "palm_bk3710",
403 .probe = palm_bk3710_probe,
404 .remove = NULL,
407 static int __init palm_bk3710_init(void)
409 return platform_driver_register(&platform_bk_driver);
412 module_init(palm_bk3710_init);
413 MODULE_LICENSE("GPL");