ide: move ide_rate_filter() calls to the upper layer (take 2)
[cascardo/linux.git] / drivers / ide / pci / cs5535.c
1 /*
2  * linux/drivers/ide/pci/cs5535.c
3  *
4  * Copyright (C) 2004-2005 Advanced Micro Devices, Inc.
5  * Copyright (C)      2007 Bartlomiej Zolnierkiewicz
6  *
7  * History:
8  * 09/20/2005 - Jaya Kumar <jayakumar.ide@gmail.com>
9  * - Reworked tuneproc, set_drive, misc mods to prep for mainline
10  * - Work was sponsored by CIS (M) Sdn Bhd.
11  * Ported to Kernel 2.6.11 on June 26, 2005 by
12  *   Wolfgang Zuleger <wolfgang.zuleger@gmx.de>
13  *   Alexander Kiausch <alex.kiausch@t-online.de>
14  * Originally developed by AMD for 2.4/2.6
15  *
16  * Development of this chipset driver was funded
17  * by the nice folks at National Semiconductor/AMD.
18  *
19  * This program is free software; you can redistribute it and/or modify it
20  * under the terms of the GNU General Public License version 2 as published by
21  * the Free Software Foundation.
22  *
23  * Documentation:
24  *  CS5535 documentation available from AMD
25  */
26
27 #include <linux/module.h>
28 #include <linux/pci.h>
29 #include <linux/ide.h>
30
31 #include "ide-timing.h"
32
33 #define MSR_ATAC_BASE           0x51300000
34 #define ATAC_GLD_MSR_CAP        (MSR_ATAC_BASE+0)
35 #define ATAC_GLD_MSR_CONFIG     (MSR_ATAC_BASE+0x01)
36 #define ATAC_GLD_MSR_SMI        (MSR_ATAC_BASE+0x02)
37 #define ATAC_GLD_MSR_ERROR      (MSR_ATAC_BASE+0x03)
38 #define ATAC_GLD_MSR_PM         (MSR_ATAC_BASE+0x04)
39 #define ATAC_GLD_MSR_DIAG       (MSR_ATAC_BASE+0x05)
40 #define ATAC_IO_BAR             (MSR_ATAC_BASE+0x08)
41 #define ATAC_RESET              (MSR_ATAC_BASE+0x10)
42 #define ATAC_CH0D0_PIO          (MSR_ATAC_BASE+0x20)
43 #define ATAC_CH0D0_DMA          (MSR_ATAC_BASE+0x21)
44 #define ATAC_CH0D1_PIO          (MSR_ATAC_BASE+0x22)
45 #define ATAC_CH0D1_DMA          (MSR_ATAC_BASE+0x23)
46 #define ATAC_PCI_ABRTERR        (MSR_ATAC_BASE+0x24)
47 #define ATAC_BM0_CMD_PRIM       0x00
48 #define ATAC_BM0_STS_PRIM       0x02
49 #define ATAC_BM0_PRD            0x04
50 #define CS5535_CABLE_DETECT     0x48
51
52 /* Format I PIO settings. We seperate out cmd and data for safer timings */
53
54 static unsigned int cs5535_pio_cmd_timings[5] =
55 { 0xF7F4, 0x53F3, 0x13F1, 0x5131, 0x1131 };
56 static unsigned int cs5535_pio_dta_timings[5] =
57 { 0xF7F4, 0xF173, 0x8141, 0x5131, 0x1131 };
58
59 static unsigned int cs5535_mwdma_timings[3] =
60 { 0x7F0FFFF3, 0x7F035352, 0x7f024241 };
61
62 static unsigned int cs5535_udma_timings[5] =
63 { 0x7F7436A1, 0x7F733481, 0x7F723261, 0x7F713161, 0x7F703061 };
64
65 /* Macros to check if the register is the reset value -  reset value is an
66    invalid timing and indicates the register has not been set previously */
67
68 #define CS5535_BAD_PIO(timings) ( (timings&~0x80000000UL) == 0x00009172 )
69 #define CS5535_BAD_DMA(timings) ( (timings & 0x000FFFFF) == 0x00077771 )
70
71 /****
72  *      cs5535_set_speed         -     Configure the chipset to the new speed
73  *      @drive: Drive to set up
74  *      @speed: desired speed
75  *
76  *      cs5535_set_speed() configures the chipset to a new speed.
77  */
78 static void cs5535_set_speed(ide_drive_t *drive, const u8 speed)
79 {
80
81         u32 reg = 0, dummy;
82         int unit = drive->select.b.unit;
83
84
85         /* Set the PIO timings */
86         if ((speed & XFER_MODE) == XFER_PIO) {
87                 ide_drive_t *pair = &drive->hwif->drives[drive->dn ^ 1];
88                 u8 cmd, pioa;
89
90                 cmd = pioa = speed - XFER_PIO_0;
91
92                 if (pair->present) {
93                         u8 piob = ide_get_best_pio_mode(pair, 255, 4);
94
95                         if (piob < cmd)
96                                 cmd = piob;
97                 }
98
99                 /* Write the speed of the current drive */
100                 reg = (cs5535_pio_cmd_timings[cmd] << 16) |
101                         cs5535_pio_dta_timings[pioa];
102                 wrmsr(unit ? ATAC_CH0D1_PIO : ATAC_CH0D0_PIO, reg, 0);
103
104                 /* And if nessesary - change the speed of the other drive */
105                 rdmsr(unit ?  ATAC_CH0D0_PIO : ATAC_CH0D1_PIO, reg, dummy);
106
107                 if (((reg >> 16) & cs5535_pio_cmd_timings[cmd]) !=
108                         cs5535_pio_cmd_timings[cmd]) {
109                         reg &= 0x0000FFFF;
110                         reg |= cs5535_pio_cmd_timings[cmd] << 16;
111                         wrmsr(unit ? ATAC_CH0D0_PIO : ATAC_CH0D1_PIO, reg, 0);
112                 }
113
114                 /* Set bit 31 of the DMA register for PIO format 1 timings */
115                 rdmsr(unit ?  ATAC_CH0D1_DMA : ATAC_CH0D0_DMA, reg, dummy);
116                 wrmsr(unit ? ATAC_CH0D1_DMA : ATAC_CH0D0_DMA,
117                                         reg | 0x80000000UL, 0);
118         } else {
119                 rdmsr(unit ? ATAC_CH0D1_DMA : ATAC_CH0D0_DMA, reg, dummy);
120
121                 reg &= 0x80000000UL;  /* Preserve the PIO format bit */
122
123                 if (speed >= XFER_UDMA_0 && speed <= XFER_UDMA_4)
124                         reg |= cs5535_udma_timings[speed - XFER_UDMA_0];
125                 else if (speed >= XFER_MW_DMA_0 && speed <= XFER_MW_DMA_2)
126                         reg |= cs5535_mwdma_timings[speed - XFER_MW_DMA_0];
127                 else
128                         return;
129
130                 wrmsr(unit ? ATAC_CH0D1_DMA : ATAC_CH0D0_DMA, reg, 0);
131         }
132 }
133
134 /****
135  *      cs5535_set_drive         -     Configure the drive to the new speed
136  *      @drive: Drive to set up
137  *      @speed: desired speed
138  *
139  *      cs5535_set_drive() configures the drive and the chipset to a
140  *      new speed. It also can be called by upper layers.
141  */
142 static int cs5535_set_drive(ide_drive_t *drive, u8 speed)
143 {
144         ide_config_drive_speed(drive, speed);
145         cs5535_set_speed(drive, speed);
146
147         return 0;
148 }
149
150 /****
151  *      cs5535_tuneproc    -       PIO setup
152  *      @drive: drive to set up
153  *      @pio: mode to use (255 for 'best possible')
154  *
155  *      A callback from the upper layers for PIO-only tuning.
156  */
157 static void cs5535_tuneproc(ide_drive_t *drive, u8 pio)
158 {
159         pio = ide_get_best_pio_mode(drive, pio, 4);
160         ide_config_drive_speed(drive, XFER_PIO_0 + pio);
161         cs5535_set_speed(drive, XFER_PIO_0 + pio);
162 }
163
164 static int cs5535_dma_check(ide_drive_t *drive)
165 {
166         drive->init_speed = 0;
167
168         if (ide_tune_dma(drive))
169                 return 0;
170
171         if (ide_use_fast_pio(drive))
172                 cs5535_tuneproc(drive, 255);
173
174         return -1;
175 }
176
177 static u8 __devinit cs5535_cable_detect(struct pci_dev *dev)
178 {
179         u8 bit;
180
181         /* if a 80 wire cable was detected */
182         pci_read_config_byte(dev, CS5535_CABLE_DETECT, &bit);
183
184         return (bit & 1) ? ATA_CBL_PATA80 : ATA_CBL_PATA40;
185 }
186
187 /****
188  *      init_hwif_cs5535        -       Initialize one ide cannel
189  *      @hwif: Channel descriptor
190  *
191  *      This gets invoked by the IDE driver once for each channel. It
192  *      performs channel-specific pre-initialization before drive probing.
193  *
194  */
195 static void __devinit init_hwif_cs5535(ide_hwif_t *hwif)
196 {
197         int i;
198
199         hwif->autodma = 0;
200
201         hwif->tuneproc = &cs5535_tuneproc;
202         hwif->speedproc = &cs5535_set_drive;
203         hwif->ide_dma_check = &cs5535_dma_check;
204
205         hwif->atapi_dma = 1;
206         hwif->ultra_mask = 0x1F;
207         hwif->mwdma_mask = 0x07;
208
209         hwif->cbl = cs5535_cable_detect(hwif->pci_dev);
210
211         if (!noautodma)
212                 hwif->autodma = 1;
213
214         /* just setting autotune and not worrying about bios timings */
215         for (i = 0; i < 2; i++) {
216                 hwif->drives[i].autotune = 1;
217                 hwif->drives[i].autodma = hwif->autodma;
218         }
219 }
220
221 static ide_pci_device_t cs5535_chipset __devinitdata = {
222         .name           = "CS5535",
223         .init_hwif      = init_hwif_cs5535,
224         .autodma        = AUTODMA,
225         .bootable       = ON_BOARD,
226         .host_flags     = IDE_HFLAG_SINGLE,
227         .pio_mask       = ATA_PIO4,
228 };
229
230 static int __devinit cs5535_init_one(struct pci_dev *dev,
231                                         const struct pci_device_id *id)
232 {
233         return ide_setup_pci_device(dev, &cs5535_chipset);
234 }
235
236 static struct pci_device_id cs5535_pci_tbl[] =
237 {
238         { PCI_VENDOR_ID_NS, PCI_DEVICE_ID_NS_CS5535_IDE, PCI_ANY_ID,
239                 PCI_ANY_ID, 0, 0, 0},
240         { 0, },
241 };
242
243 MODULE_DEVICE_TABLE(pci, cs5535_pci_tbl);
244
245 static struct pci_driver driver = {
246         .name       = "CS5535_IDE",
247         .id_table   = cs5535_pci_tbl,
248         .probe      = cs5535_init_one,
249 };
250
251 static int __init cs5535_ide_init(void)
252 {
253         return ide_pci_register_driver(&driver);
254 }
255
256 module_init(cs5535_ide_init);
257
258 MODULE_AUTHOR("AMD");
259 MODULE_DESCRIPTION("PCI driver module for AMD/NS CS5535 IDE");
260 MODULE_LICENSE("GPL");