]>
Commit | Line | Data |
---|---|---|
67881826 BZ |
1 | /* |
2 | * ITE 8213 IDE driver | |
3 | * | |
4 | * Copyright (C) 2006 Jack Lee | |
5 | * Copyright (C) 2006 Alan Cox | |
6 | * Copyright (C) 2007 Bartlomiej Zolnierkiewicz | |
7 | */ | |
8 | ||
9c6712c0 JL |
9 | #include <linux/kernel.h> |
10 | #include <linux/types.h> | |
11 | #include <linux/module.h> | |
12 | #include <linux/pci.h> | |
9c6712c0 JL |
13 | #include <linux/hdreg.h> |
14 | #include <linux/ide.h> | |
15 | #include <linux/init.h> | |
16 | ||
88b2b32b BZ |
17 | /** |
18 | * it8213_set_pio_mode - set host controller for PIO mode | |
19 | * @drive: drive | |
20 | * @pio: PIO mode number | |
9c6712c0 | 21 | * |
67881826 | 22 | * Set the interface PIO mode. |
9c6712c0 JL |
23 | */ |
24 | ||
88b2b32b | 25 | static void it8213_set_pio_mode(ide_drive_t *drive, const u8 pio) |
9c6712c0 JL |
26 | { |
27 | ide_hwif_t *hwif = HWIF(drive); | |
36501650 | 28 | struct pci_dev *dev = to_pci_dev(hwif->dev); |
67881826 | 29 | int is_slave = drive->dn & 1; |
9c6712c0 JL |
30 | int master_port = 0x40; |
31 | int slave_port = 0x44; | |
32 | unsigned long flags; | |
33 | u16 master_data; | |
34 | u8 slave_data; | |
67881826 BZ |
35 | static DEFINE_SPINLOCK(tune_lock); |
36 | int control = 0; | |
9c6712c0 | 37 | |
a2826190 | 38 | static const u8 timings[][2] = { |
67881826 BZ |
39 | { 0, 0 }, |
40 | { 0, 0 }, | |
41 | { 1, 0 }, | |
42 | { 2, 1 }, | |
43 | { 2, 3 }, }; | |
9c6712c0 | 44 | |
9c6712c0 JL |
45 | spin_lock_irqsave(&tune_lock, flags); |
46 | pci_read_config_word(dev, master_port, &master_data); | |
67881826 BZ |
47 | |
48 | if (pio > 1) | |
49 | control |= 1; /* Programmable timing on */ | |
50 | if (drive->media != ide_disk) | |
51 | control |= 4; /* ATAPI */ | |
52 | if (pio > 2) | |
53 | control |= 2; /* IORDY */ | |
9c6712c0 | 54 | if (is_slave) { |
67881826 BZ |
55 | master_data |= 0x4000; |
56 | master_data &= ~0x0070; | |
9c6712c0 | 57 | if (pio > 1) |
67881826 | 58 | master_data = master_data | (control << 4); |
9c6712c0 JL |
59 | pci_read_config_byte(dev, slave_port, &slave_data); |
60 | slave_data = slave_data & 0xf0; | |
67881826 | 61 | slave_data = slave_data | (timings[pio][0] << 2) | timings[pio][1]; |
9c6712c0 | 62 | } else { |
67881826 | 63 | master_data &= ~0x3307; |
9c6712c0 | 64 | if (pio > 1) |
67881826 | 65 | master_data = master_data | control; |
9c6712c0 JL |
66 | master_data = master_data | (timings[pio][0] << 12) | (timings[pio][1] << 8); |
67 | } | |
68 | pci_write_config_word(dev, master_port, master_data); | |
69 | if (is_slave) | |
70 | pci_write_config_byte(dev, slave_port, slave_data); | |
71 | spin_unlock_irqrestore(&tune_lock, flags); | |
72 | } | |
73 | ||
9c6712c0 | 74 | /** |
88b2b32b BZ |
75 | * it8213_set_dma_mode - set host controller for DMA mode |
76 | * @drive: drive | |
77 | * @speed: DMA mode | |
9c6712c0 | 78 | * |
88b2b32b | 79 | * Tune the ITE chipset for the DMA mode. |
9c6712c0 JL |
80 | */ |
81 | ||
88b2b32b | 82 | static void it8213_set_dma_mode(ide_drive_t *drive, const u8 speed) |
9c6712c0 | 83 | { |
9c6712c0 | 84 | ide_hwif_t *hwif = HWIF(drive); |
36501650 | 85 | struct pci_dev *dev = to_pci_dev(hwif->dev); |
9c6712c0 | 86 | u8 maslave = 0x40; |
9c6712c0 JL |
87 | int a_speed = 3 << (drive->dn * 4); |
88 | int u_flag = 1 << drive->dn; | |
89 | int v_flag = 0x01 << drive->dn; | |
90 | int w_flag = 0x10 << drive->dn; | |
91 | int u_speed = 0; | |
92 | u16 reg4042, reg4a; | |
1c54a93d | 93 | u8 reg48, reg54, reg55; |
9c6712c0 JL |
94 | |
95 | pci_read_config_word(dev, maslave, ®4042); | |
96 | pci_read_config_byte(dev, 0x48, ®48); | |
97 | pci_read_config_word(dev, 0x4a, ®4a); | |
98 | pci_read_config_byte(dev, 0x54, ®54); | |
99 | pci_read_config_byte(dev, 0x55, ®55); | |
100 | ||
67881826 | 101 | if (speed >= XFER_UDMA_0) { |
4db90a14 BZ |
102 | u8 udma = speed - XFER_UDMA_0; |
103 | ||
104 | u_speed = min_t(u8, 2 - (udma & 1), udma) << (drive->dn * 4); | |
105 | ||
9c6712c0 JL |
106 | if (!(reg48 & u_flag)) |
107 | pci_write_config_byte(dev, 0x48, reg48 | u_flag); | |
a2826190 | 108 | if (speed >= XFER_UDMA_5) |
9c6712c0 | 109 | pci_write_config_byte(dev, 0x55, (u8) reg55|w_flag); |
a2826190 | 110 | else |
9c6712c0 | 111 | pci_write_config_byte(dev, 0x55, (u8) reg55 & ~w_flag); |
9c6712c0 JL |
112 | |
113 | if ((reg4a & a_speed) != u_speed) | |
114 | pci_write_config_word(dev, 0x4a, (reg4a & ~a_speed) | u_speed); | |
67881826 | 115 | if (speed > XFER_UDMA_2) { |
9c6712c0 JL |
116 | if (!(reg54 & v_flag)) |
117 | pci_write_config_byte(dev, 0x54, reg54 | v_flag); | |
118 | } else | |
119 | pci_write_config_byte(dev, 0x54, reg54 & ~v_flag); | |
67881826 | 120 | } else { |
8c91abf8 | 121 | const u8 mwdma_to_pio[] = { 0, 3, 4 }; |
1c54a93d | 122 | u8 pio; |
8c91abf8 | 123 | |
9c6712c0 JL |
124 | if (reg48 & u_flag) |
125 | pci_write_config_byte(dev, 0x48, reg48 & ~u_flag); | |
126 | if (reg4a & a_speed) | |
127 | pci_write_config_word(dev, 0x4a, reg4a & ~a_speed); | |
128 | if (reg54 & v_flag) | |
129 | pci_write_config_byte(dev, 0x54, reg54 & ~v_flag); | |
130 | if (reg55 & w_flag) | |
131 | pci_write_config_byte(dev, 0x55, (u8) reg55 & ~w_flag); | |
8c91abf8 BZ |
132 | |
133 | if (speed >= XFER_MW_DMA_0) | |
134 | pio = mwdma_to_pio[speed - XFER_MW_DMA_0]; | |
135 | else | |
136 | pio = 2; /* only SWDMA2 is allowed */ | |
68aaf815 | 137 | |
1c54a93d BZ |
138 | it8213_set_pio_mode(drive, pio); |
139 | } | |
67881826 | 140 | } |
9c6712c0 | 141 | |
bfa14b42 BZ |
142 | static u8 __devinit it8213_cable_detect(ide_hwif_t *hwif) |
143 | { | |
144 | struct pci_dev *dev = to_pci_dev(hwif->dev); | |
145 | u8 reg42h = 0; | |
146 | ||
147 | pci_read_config_byte(dev, 0x42, ®42h); | |
148 | ||
149 | return (reg42h & 0x02) ? ATA_CBL_PATA40 : ATA_CBL_PATA80; | |
150 | } | |
151 | ||
9c6712c0 JL |
152 | /** |
153 | * init_hwif_it8213 - set up hwif structs | |
154 | * @hwif: interface to set up | |
155 | * | |
0ae2e178 | 156 | * We do the basic set up of the interface structure. |
9c6712c0 JL |
157 | */ |
158 | ||
159 | static void __devinit init_hwif_it8213(ide_hwif_t *hwif) | |
160 | { | |
88b2b32b | 161 | hwif->set_dma_mode = &it8213_set_dma_mode; |
26bcb879 | 162 | hwif->set_pio_mode = &it8213_set_pio_mode; |
9c6712c0 | 163 | |
bfa14b42 | 164 | hwif->cable_detect = it8213_cable_detect; |
9c6712c0 JL |
165 | } |
166 | ||
167 | ||
168 | #define DECLARE_ITE_DEV(name_str) \ | |
169 | { \ | |
170 | .name = name_str, \ | |
9c6712c0 | 171 | .init_hwif = init_hwif_it8213, \ |
a2826190 | 172 | .enablebits = { {0x41, 0x80, 0x80} }, \ |
5e71d9c5 | 173 | .host_flags = IDE_HFLAG_SINGLE, \ |
4099d143 | 174 | .pio_mask = ATA_PIO4, \ |
5f8b6c34 BZ |
175 | .swdma_mask = ATA_SWDMA2_ONLY, \ |
176 | .mwdma_mask = ATA_MWDMA12_ONLY, \ | |
177 | .udma_mask = ATA_UDMA6, \ | |
9c6712c0 JL |
178 | } |
179 | ||
85620436 | 180 | static const struct ide_port_info it8213_chipsets[] __devinitdata = { |
9c6712c0 JL |
181 | /* 0 */ DECLARE_ITE_DEV("IT8213"), |
182 | }; | |
183 | ||
184 | ||
185 | /** | |
186 | * it8213_init_one - pci layer discovery entry | |
187 | * @dev: PCI device | |
188 | * @id: ident table entry | |
189 | * | |
190 | * Called by the PCI code when it finds an ITE8213 controller. As | |
191 | * this device follows the standard interfaces we can use the | |
192 | * standard helper functions to do almost all the work for us. | |
193 | */ | |
194 | ||
195 | static int __devinit it8213_init_one(struct pci_dev *dev, const struct pci_device_id *id) | |
196 | { | |
197 | ide_setup_pci_device(dev, &it8213_chipsets[id->driver_data]); | |
198 | return 0; | |
199 | } | |
200 | ||
9cbcc5e3 BZ |
201 | static const struct pci_device_id it8213_pci_tbl[] = { |
202 | { PCI_VDEVICE(ITE, PCI_DEVICE_ID_ITE_8213), 0 }, | |
9c6712c0 JL |
203 | { 0, }, |
204 | }; | |
205 | ||
206 | MODULE_DEVICE_TABLE(pci, it8213_pci_tbl); | |
207 | ||
208 | static struct pci_driver driver = { | |
209 | .name = "ITE8213_IDE", | |
210 | .id_table = it8213_pci_tbl, | |
211 | .probe = it8213_init_one, | |
212 | }; | |
213 | ||
214 | static int __init it8213_ide_init(void) | |
215 | { | |
67881826 BZ |
216 | return ide_pci_register_driver(&driver); |
217 | } | |
9c6712c0 JL |
218 | |
219 | module_init(it8213_ide_init); | |
220 | ||
67881826 | 221 | MODULE_AUTHOR("Jack Lee, Alan Cox"); |
9c6712c0 JL |
222 | MODULE_DESCRIPTION("PCI driver module for the ITE 8213"); |
223 | MODULE_LICENSE("GPL"); |