ata_piix.c 31.5 KB
Newer Older
L
Linus Torvalds 已提交
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 39
 *    ata_piix.c - Intel PATA/SATA controllers
 *
 *    Maintained by:  Jeff Garzik <jgarzik@pobox.com>
 *    		    Please ALWAYS copy linux-ide@vger.kernel.org
 *		    on emails.
 *
 *
 *	Copyright 2003-2005 Red Hat Inc
 *	Copyright 2003-2005 Jeff Garzik
 *
 *
 *	Copyright header from piix.c:
 *
 *  Copyright (C) 1998-1999 Andrzej Krzysztofowicz, Author and Maintainer
 *  Copyright (C) 1998-2000 Andre Hedrick <andre@linux-ide.org>
 *  Copyright (C) 2003 Red Hat Inc <alan@redhat.com>
 *
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation; either version 2, or (at your option)
 *  any later version.
 *
 *  This program is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with this program; see the file COPYING.  If not, write to
 *  the Free Software Foundation, 675 Mass Ave, Cambridge, MA 02139, USA.
 *
 *
 *  libata documentation is available via 'make {ps|pdf}docs',
 *  as Documentation/DocBook/libata.*
 *
 *  Hardware documentation available at http://developer.intel.com/
 *
A
Alan Cox 已提交
40 41 42
 * Documentation
 *	Publically available from Intel web site. Errata documentation
 * is also publically available. As an aide to anyone hacking on this
43
 * driver the list of errata that are relevant is below, going back to
A
Alan Cox 已提交
44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82
 * PIIX4. Older device documentation is now a bit tricky to find.
 *
 * The chipsets all follow very much the same design. The orginal Triton
 * series chipsets do _not_ support independant device timings, but this
 * is fixed in Triton II. With the odd mobile exception the chips then
 * change little except in gaining more modes until SATA arrives. This
 * driver supports only the chips with independant timing (that is those
 * with SITRE and the 0x44 timing register). See pata_oldpiix and pata_mpiix
 * for the early chip drivers.
 *
 * Errata of note:
 *
 * Unfixable
 *	PIIX4    errata #9	- Only on ultra obscure hw
 *	ICH3	 errata #13     - Not observed to affect real hw
 *				  by Intel
 *
 * Things we must deal with
 *	PIIX4	errata #10	- BM IDE hang with non UDMA
 *				  (must stop/start dma to recover)
 *	440MX   errata #15	- As PIIX4 errata #10
 *	PIIX4	errata #15	- Must not read control registers
 * 				  during a PIO transfer
 *	440MX   errata #13	- As PIIX4 errata #15
 *	ICH2	errata #21	- DMA mode 0 doesn't work right
 *	ICH0/1  errata #55	- As ICH2 errata #21
 *	ICH2	spec c #9	- Extra operations needed to handle
 *				  drive hotswap [NOT YET SUPPORTED]
 *	ICH2    spec c #20	- IDE PRD must not cross a 64K boundary
 *				  and must be dword aligned
 *	ICH2    spec c #24	- UDMA mode 4,5 t85/86 should be 6ns not 3.3
 *
 * Should have been BIOS fixed:
 *	450NX:	errata #19	- DMA hangs on old 450NX
 *	450NX:  errata #20	- DMA hangs on old 450NX
 *	450NX:  errata #25	- Corruption with DMA on old 450NX
 *	ICH3    errata #15      - IDE deadlock under high load
 *				  (BIOS must set dev 31 fn 0 bit 23)
 *	ICH3	errata #18	- Don't use native mode
L
Linus Torvalds 已提交
83 84 85 86 87 88 89 90
 */

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/pci.h>
#include <linux/init.h>
#include <linux/blkdev.h>
#include <linux/delay.h>
91
#include <linux/device.h>
L
Linus Torvalds 已提交
92 93 94 95
#include <scsi/scsi_host.h>
#include <linux/libata.h>

#define DRV_NAME	"ata_piix"
A
Alan Cox 已提交
96
#define DRV_VERSION	"2.11"
L
Linus Torvalds 已提交
97 98 99 100 101

enum {
	PIIX_IOCFG		= 0x54, /* IDE I/O configuration register */
	ICH5_PMR		= 0x90, /* port mapping register */
	ICH5_PCS		= 0x92,	/* port control and status */
102
	PIIX_SCC		= 0x0A, /* sub-class code register */
L
Linus Torvalds 已提交
103

104
	PIIX_FLAG_SCR		= (1 << 26), /* SCR available */
105 106
	PIIX_FLAG_AHCI		= (1 << 27), /* AHCI possible */
	PIIX_FLAG_CHECKINTR	= (1 << 28), /* make sure PCI INTx enabled */
L
Linus Torvalds 已提交
107

108 109
	PIIX_PATA_FLAGS		= ATA_FLAG_SLAVE_POSS,
	PIIX_SATA_FLAGS		= ATA_FLAG_SATA | PIIX_FLAG_CHECKINTR,
T
Tejun Heo 已提交
110

L
Linus Torvalds 已提交
111 112 113
	/* combined mode.  if set, PATA is channel 0.
	 * if clear, PATA is channel 1.
	 */
114 115
	PIIX_PORT_ENABLED	= (1 << 0),
	PIIX_PORT_PRESENT	= (1 << 4),
L
Linus Torvalds 已提交
116 117 118 119

	PIIX_80C_PRI		= (1 << 5) | (1 << 4),
	PIIX_80C_SEC		= (1 << 7) | (1 << 6),

120
	/* controller IDs */
A
Alan 已提交
121
	piix_pata_33		= 0,	/* PIIX4 at 33Mhz */
122 123 124 125 126
	ich_pata_33		= 1,	/* ICH up to UDMA 33 only */
	ich_pata_66		= 2,	/* ICH up to 66 Mhz */
	ich_pata_100		= 3,	/* ICH up to UDMA 100 */
	ich_pata_133		= 4,	/* ICH up to UDMA 133 */
	ich5_sata		= 5,
127 128 129 130
	ich6_sata		= 6,
	ich6_sata_ahci		= 7,
	ich6m_sata_ahci		= 8,
	ich8_sata_ahci		= 9,
A
Alan 已提交
131
	piix_pata_mwdma		= 10,	/* PIIX3 MWDMA only */
132

133 134 135 136 137 138 139 140 141
	/* constants for mapping table */
	P0			= 0,  /* port 0 */
	P1			= 1,  /* port 1 */
	P2			= 2,  /* port 2 */
	P3			= 3,  /* port 3 */
	IDE			= -1, /* IDE */
	NA			= -2, /* not avaliable */
	RV			= -3, /* reserved */

142
	PIIX_AHCI_DEVICE	= 6,
L
Linus Torvalds 已提交
143 144
};

145 146
struct piix_map_db {
	const u32 mask;
147
	const u16 port_enable;
148 149 150
	const int map[][4];
};

151 152 153 154
struct piix_host_priv {
	const int *map;
};

L
Linus Torvalds 已提交
155 156
static int piix_init_one (struct pci_dev *pdev,
				    const struct pci_device_id *ent);
157 158
static void piix_pata_error_handler(struct ata_port *ap);
static void piix_sata_error_handler(struct ata_port *ap);
159 160 161
static void piix_set_piomode (struct ata_port *ap, struct ata_device *adev);
static void piix_set_dmamode (struct ata_port *ap, struct ata_device *adev);
static void ich_set_dmamode (struct ata_port *ap, struct ata_device *adev);
A
Alan Cox 已提交
162
static int ich_pata_cable_detect(struct ata_port *ap);
L
Linus Torvalds 已提交
163 164 165

static unsigned int in_module_init = 1;

166
static const struct pci_device_id piix_pci_tbl[] = {
A
Alan 已提交
167 168
	/* Intel PIIX3 for the 430HX etc */
	{ 0x8086, 0x7010, PCI_ANY_ID, PCI_ANY_ID, 0, 0, piix_pata_mwdma },
169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196
	/* Intel PIIX4 for the 430TX/440BX/MX chipset: UDMA 33 */
	/* Also PIIX4E (fn3 rev 2) and PIIX4M (fn3 rev 3) */
	{ 0x8086, 0x7111, PCI_ANY_ID, PCI_ANY_ID, 0, 0, piix_pata_33 },
	/* Intel PIIX4 */
	{ 0x8086, 0x7199, PCI_ANY_ID, PCI_ANY_ID, 0, 0, piix_pata_33 },
	/* Intel PIIX4 */
	{ 0x8086, 0x7601, PCI_ANY_ID, PCI_ANY_ID, 0, 0, piix_pata_33 },
	/* Intel PIIX */
	{ 0x8086, 0x84CA, PCI_ANY_ID, PCI_ANY_ID, 0, 0, piix_pata_33 },
	/* Intel ICH (i810, i815, i840) UDMA 66*/
	{ 0x8086, 0x2411, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_66 },
	/* Intel ICH0 : UDMA 33*/
	{ 0x8086, 0x2421, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_33 },
	/* Intel ICH2M */
	{ 0x8086, 0x244A, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_100 },
	/* Intel ICH2 (i810E2, i845, 850, 860) UDMA 100 */
	{ 0x8086, 0x244B, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_100 },
	/*  Intel ICH3M */
	{ 0x8086, 0x248A, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_100 },
	/* Intel ICH3 (E7500/1) UDMA 100 */
	{ 0x8086, 0x248B, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_100 },
	/* Intel ICH4 (i845GV, i845E, i852, i855) UDMA 100 */
	{ 0x8086, 0x24CA, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_100 },
	{ 0x8086, 0x24CB, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_100 },
	/* Intel ICH5 */
	{ 0x8086, 0x24DB, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_133 },
	/* C-ICH (i810E2) */
	{ 0x8086, 0x245B, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_100 },
197
	/* ESB (855GME/875P + 6300ESB) UDMA 100  */
198 199 200 201 202 203
	{ 0x8086, 0x25A2, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_100 },
	/* ICH6 (and 6) (i915) UDMA 100 */
	{ 0x8086, 0x266F, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_100 },
	/* ICH7/7-R (i945, i975) UDMA 100*/
	{ 0x8086, 0x27DF, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_133 },
	{ 0x8086, 0x269E, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_100 },
L
Linus Torvalds 已提交
204 205 206 207 208

	/* NOTE: The following PCI ids must be kept in sync with the
	 * list in drivers/pci/quirks.c.
	 */

209
	/* 82801EB (ICH5) */
L
Linus Torvalds 已提交
210
	{ 0x8086, 0x24d1, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich5_sata },
211
	/* 82801EB (ICH5) */
L
Linus Torvalds 已提交
212
	{ 0x8086, 0x24df, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich5_sata },
213
	/* 6300ESB (ICH5 variant with broken PCS present bits) */
214
	{ 0x8086, 0x25a3, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich5_sata },
215
	/* 6300ESB pretending RAID */
216
	{ 0x8086, 0x25b0, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich5_sata },
217
	/* 82801FB/FW (ICH6/ICH6W) */
L
Linus Torvalds 已提交
218
	{ 0x8086, 0x2651, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich6_sata },
219
	/* 82801FR/FRW (ICH6R/ICH6RW) */
220
	{ 0x8086, 0x2652, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich6_sata_ahci },
221 222 223
	/* 82801FBM ICH6M (ICH6R with only port 0 and 2 implemented) */
	{ 0x8086, 0x2653, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich6m_sata_ahci },
	/* 82801GB/GR/GH (ICH7, identical to ICH6) */
224
	{ 0x8086, 0x27c0, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich6_sata_ahci },
225
	/* 2801GBM/GHM (ICH7M, identical to ICH6M) */
226
	{ 0x8086, 0x27c4, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich6m_sata_ahci },
227
	/* Enterprise Southbridge 2 (631xESB/632xESB) */
228
	{ 0x8086, 0x2680, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich6_sata_ahci },
229
	/* SATA Controller 1 IDE (ICH8) */
230
	{ 0x8086, 0x2820, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata_ahci },
231
	/* SATA Controller 2 IDE (ICH8) */
232
	{ 0x8086, 0x2825, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata_ahci },
233
	/* Mobile SATA Controller IDE (ICH8M) */
234
	{ 0x8086, 0x2828, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata_ahci },
235 236 237 238 239 240 241 242 243 244 245 246
	/* SATA Controller IDE (ICH9) */
	{ 0x8086, 0x2920, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata_ahci },
	/* SATA Controller IDE (ICH9) */
	{ 0x8086, 0x2921, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata_ahci },
	/* SATA Controller IDE (ICH9) */
	{ 0x8086, 0x2926, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata_ahci },
	/* SATA Controller IDE (ICH9M) */
	{ 0x8086, 0x2928, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata_ahci },
	/* SATA Controller IDE (ICH9M) */
	{ 0x8086, 0x292d, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata_ahci },
	/* SATA Controller IDE (ICH9M) */
	{ 0x8086, 0x292e, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata_ahci },
L
Linus Torvalds 已提交
247 248 249 250 251 252 253 254 255

	{ }	/* terminate list */
};

static struct pci_driver piix_pci_driver = {
	.name			= DRV_NAME,
	.id_table		= piix_pci_tbl,
	.probe			= piix_init_one,
	.remove			= ata_pci_remove_one,
256
#ifdef CONFIG_PM
J
Jens Axboe 已提交
257 258
	.suspend		= ata_pci_device_suspend,
	.resume			= ata_pci_device_resume,
259
#endif
L
Linus Torvalds 已提交
260 261
};

262
static struct scsi_host_template piix_sht = {
L
Linus Torvalds 已提交
263 264 265 266 267 268 269 270 271 272 273 274 275
	.module			= THIS_MODULE,
	.name			= DRV_NAME,
	.ioctl			= ata_scsi_ioctl,
	.queuecommand		= ata_scsi_queuecmd,
	.can_queue		= ATA_DEF_QUEUE,
	.this_id		= ATA_SHT_THIS_ID,
	.sg_tablesize		= LIBATA_MAX_PRD,
	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN,
	.emulated		= ATA_SHT_EMULATED,
	.use_clustering		= ATA_SHT_USE_CLUSTERING,
	.proc_name		= DRV_NAME,
	.dma_boundary		= ATA_DMA_BOUNDARY,
	.slave_configure	= ata_scsi_slave_config,
T
Tejun Heo 已提交
276
	.slave_destroy		= ata_scsi_slave_destroy,
L
Linus Torvalds 已提交
277 278 279
	.bios_param		= ata_std_bios_param,
};

J
Jeff Garzik 已提交
280
static const struct ata_port_operations piix_pata_ops = {
L
Linus Torvalds 已提交
281 282 283
	.port_disable		= ata_port_disable,
	.set_piomode		= piix_set_piomode,
	.set_dmamode		= piix_set_dmamode,
284
	.mode_filter		= ata_pci_default_filter,
L
Linus Torvalds 已提交
285 286 287 288 289 290 291 292 293 294 295 296 297

	.tf_load		= ata_tf_load,
	.tf_read		= ata_tf_read,
	.check_status		= ata_check_status,
	.exec_command		= ata_exec_command,
	.dev_select		= ata_std_dev_select,

	.bmdma_setup		= ata_bmdma_setup,
	.bmdma_start		= ata_bmdma_start,
	.bmdma_stop		= ata_bmdma_stop,
	.bmdma_status		= ata_bmdma_status,
	.qc_prep		= ata_qc_prep,
	.qc_issue		= ata_qc_issue_prot,
T
Tejun Heo 已提交
298
	.data_xfer		= ata_data_xfer,
L
Linus Torvalds 已提交
299

T
Tejun Heo 已提交
300 301
	.freeze			= ata_bmdma_freeze,
	.thaw			= ata_bmdma_thaw,
302
	.error_handler		= piix_pata_error_handler,
T
Tejun Heo 已提交
303
	.post_internal_cmd	= ata_bmdma_post_internal_cmd,
A
Alan Cox 已提交
304
	.cable_detect		= ata_cable_40wire,
L
Linus Torvalds 已提交
305 306 307

	.irq_handler		= ata_interrupt,
	.irq_clear		= ata_bmdma_irq_clear,
308 309
	.irq_on			= ata_irq_on,
	.irq_ack		= ata_irq_ack,
L
Linus Torvalds 已提交
310 311 312 313

	.port_start		= ata_port_start,
};

314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331
static const struct ata_port_operations ich_pata_ops = {
	.port_disable		= ata_port_disable,
	.set_piomode		= piix_set_piomode,
	.set_dmamode		= ich_set_dmamode,
	.mode_filter		= ata_pci_default_filter,

	.tf_load		= ata_tf_load,
	.tf_read		= ata_tf_read,
	.check_status		= ata_check_status,
	.exec_command		= ata_exec_command,
	.dev_select		= ata_std_dev_select,

	.bmdma_setup		= ata_bmdma_setup,
	.bmdma_start		= ata_bmdma_start,
	.bmdma_stop		= ata_bmdma_stop,
	.bmdma_status		= ata_bmdma_status,
	.qc_prep		= ata_qc_prep,
	.qc_issue		= ata_qc_issue_prot,
T
Tejun Heo 已提交
332
	.data_xfer		= ata_data_xfer,
333 334 335

	.freeze			= ata_bmdma_freeze,
	.thaw			= ata_bmdma_thaw,
A
Alan Cox 已提交
336
	.error_handler		= piix_pata_error_handler,
337
	.post_internal_cmd	= ata_bmdma_post_internal_cmd,
A
Alan Cox 已提交
338
	.cable_detect		= ich_pata_cable_detect,
339 340 341

	.irq_handler		= ata_interrupt,
	.irq_clear		= ata_bmdma_irq_clear,
342 343
	.irq_on			= ata_irq_on,
	.irq_ack		= ata_irq_ack,
344 345 346 347

	.port_start		= ata_port_start,
};

J
Jeff Garzik 已提交
348
static const struct ata_port_operations piix_sata_ops = {
L
Linus Torvalds 已提交
349 350 351 352 353 354 355 356 357 358 359 360 361 362
	.port_disable		= ata_port_disable,

	.tf_load		= ata_tf_load,
	.tf_read		= ata_tf_read,
	.check_status		= ata_check_status,
	.exec_command		= ata_exec_command,
	.dev_select		= ata_std_dev_select,

	.bmdma_setup		= ata_bmdma_setup,
	.bmdma_start		= ata_bmdma_start,
	.bmdma_stop		= ata_bmdma_stop,
	.bmdma_status		= ata_bmdma_status,
	.qc_prep		= ata_qc_prep,
	.qc_issue		= ata_qc_issue_prot,
T
Tejun Heo 已提交
363
	.data_xfer		= ata_data_xfer,
L
Linus Torvalds 已提交
364

T
Tejun Heo 已提交
365 366
	.freeze			= ata_bmdma_freeze,
	.thaw			= ata_bmdma_thaw,
367
	.error_handler		= piix_sata_error_handler,
T
Tejun Heo 已提交
368
	.post_internal_cmd	= ata_bmdma_post_internal_cmd,
L
Linus Torvalds 已提交
369 370 371

	.irq_handler		= ata_interrupt,
	.irq_clear		= ata_bmdma_irq_clear,
372 373
	.irq_on			= ata_irq_on,
	.irq_ack		= ata_irq_ack,
L
Linus Torvalds 已提交
374 375 376 377

	.port_start		= ata_port_start,
};

378
static const struct piix_map_db ich5_map_db = {
379
	.mask = 0x7,
380
	.port_enable = 0x3,
381 382 383 384 385 386 387 388 389 390 391 392 393
	.map = {
		/* PM   PS   SM   SS       MAP  */
		{  P0,  NA,  P1,  NA }, /* 000b */
		{  P1,  NA,  P0,  NA }, /* 001b */
		{  RV,  RV,  RV,  RV },
		{  RV,  RV,  RV,  RV },
		{  P0,  P1, IDE, IDE }, /* 100b */
		{  P1,  P0, IDE, IDE }, /* 101b */
		{ IDE, IDE,  P0,  P1 }, /* 110b */
		{ IDE, IDE,  P1,  P0 }, /* 111b */
	},
};

394
static const struct piix_map_db ich6_map_db = {
395
	.mask = 0x3,
396
	.port_enable = 0xf,
397 398
	.map = {
		/* PM   PS   SM   SS       MAP */
T
Tejun Heo 已提交
399
		{  P0,  P2,  P1,  P3 }, /* 00b */
400 401 402 403 404 405
		{ IDE, IDE,  P1,  P3 }, /* 01b */
		{  P0,  P2, IDE, IDE }, /* 10b */
		{  RV,  RV,  RV,  RV },
	},
};

406
static const struct piix_map_db ich6m_map_db = {
407
	.mask = 0x3,
408
	.port_enable = 0x5,
409 410

	/* Map 01b isn't specified in the doc but some notebooks use
411 412
	 * it anyway.  MAP 01b have been spotted on both ICH6M and
	 * ICH7M.
413 414 415 416 417 418 419 420 421 422
	 */
	.map = {
		/* PM   PS   SM   SS       MAP */
		{  P0,  P2,  RV,  RV }, /* 00b */
		{ IDE, IDE,  P1,  P3 }, /* 01b */
		{  P0,  P2, IDE, IDE }, /* 10b */
		{  RV,  RV,  RV,  RV },
	},
};

423 424 425 426 427
static const struct piix_map_db ich8_map_db = {
	.mask = 0x3,
	.port_enable = 0x3,
	.map = {
		/* PM   PS   SM   SS       MAP */
428
		{  P0,  P2,  P1,  P3 }, /* 00b (hardwired when in AHCI) */
429
		{  RV,  RV,  RV,  RV },
430
		{  IDE,  IDE,  NA,  NA }, /* 10b (IDE mode) */
431 432 433 434
		{  RV,  RV,  RV,  RV },
	},
};

435 436 437 438 439
static const struct piix_map_db *piix_map_db_table[] = {
	[ich5_sata]		= &ich5_map_db,
	[ich6_sata]		= &ich6_map_db,
	[ich6_sata_ahci]	= &ich6_map_db,
	[ich6m_sata_ahci]	= &ich6m_map_db,
440
	[ich8_sata_ahci]	= &ich8_map_db,
441 442
};

L
Linus Torvalds 已提交
443
static struct ata_port_info piix_port_info[] = {
A
Alan 已提交
444
	/* piix_pata_33: 0:  PIIX4 at 33MHz */
445 446
	{
		.sht		= &piix_sht,
T
Tejun Heo 已提交
447
		.flags		= PIIX_PATA_FLAGS,
448
		.pio_mask	= 0x1f,	/* pio0-4 */
449
		.mwdma_mask	= 0x06, /* mwdma1-2 ?? CHECK 0 should be ok but slow */
450 451 452 453
		.udma_mask	= ATA_UDMA_MASK_40C,
		.port_ops	= &piix_pata_ops,
	},

454 455 456
	/* ich_pata_33: 1 	ICH0 - ICH at 33Mhz*/
	{
		.sht		= &piix_sht,
T
Tejun Heo 已提交
457
		.flags		= PIIX_PATA_FLAGS,
458 459 460 461 462 463
		.pio_mask 	= 0x1f,	/* pio 0-4 */
		.mwdma_mask	= 0x06, /* Check: maybe 0x07  */
		.udma_mask	= ATA_UDMA2, /* UDMA33 */
		.port_ops	= &ich_pata_ops,
	},
	/* ich_pata_66: 2 	ICH controllers up to 66MHz */
L
Linus Torvalds 已提交
464 465
	{
		.sht		= &piix_sht,
T
Tejun Heo 已提交
466
		.flags		= PIIX_PATA_FLAGS,
467 468 469 470 471
		.pio_mask 	= 0x1f,	/* pio 0-4 */
		.mwdma_mask	= 0x06, /* MWDMA0 is broken on chip */
		.udma_mask	= ATA_UDMA4,
		.port_ops	= &ich_pata_ops,
	},
472

473 474 475
	/* ich_pata_100: 3 */
	{
		.sht		= &piix_sht,
T
Tejun Heo 已提交
476
		.flags		= PIIX_PATA_FLAGS | PIIX_FLAG_CHECKINTR,
L
Linus Torvalds 已提交
477 478
		.pio_mask	= 0x1f,	/* pio0-4 */
		.mwdma_mask	= 0x06, /* mwdma1-2 */
479 480
		.udma_mask	= ATA_UDMA5, /* udma0-5 */
		.port_ops	= &ich_pata_ops,
L
Linus Torvalds 已提交
481 482
	},

483 484 485
	/* ich_pata_133: 4 	ICH with full UDMA6 */
	{
		.sht		= &piix_sht,
T
Tejun Heo 已提交
486
		.flags		= PIIX_PATA_FLAGS | PIIX_FLAG_CHECKINTR,
487 488 489 490 491 492 493
		.pio_mask 	= 0x1f,	/* pio 0-4 */
		.mwdma_mask	= 0x06, /* Check: maybe 0x07  */
		.udma_mask	= ATA_UDMA6, /* UDMA133 */
		.port_ops	= &ich_pata_ops,
	},

	/* ich5_sata: 5 */
L
Linus Torvalds 已提交
494 495
	{
		.sht		= &piix_sht,
496
		.flags		= PIIX_SATA_FLAGS,
L
Linus Torvalds 已提交
497 498 499 500 501 502
		.pio_mask	= 0x1f,	/* pio0-4 */
		.mwdma_mask	= 0x07, /* mwdma0-2 */
		.udma_mask	= 0x7f,	/* udma0-6 */
		.port_ops	= &piix_sata_ops,
	},

503
	/* ich6_sata: 6 */
L
Linus Torvalds 已提交
504 505
	{
		.sht		= &piix_sht,
T
Tejun Heo 已提交
506
		.flags		= PIIX_SATA_FLAGS | PIIX_FLAG_SCR,
L
Linus Torvalds 已提交
507 508 509 510 511 512
		.pio_mask	= 0x1f,	/* pio0-4 */
		.mwdma_mask	= 0x07, /* mwdma0-2 */
		.udma_mask	= 0x7f,	/* udma0-6 */
		.port_ops	= &piix_sata_ops,
	},

513
	/* ich6_sata_ahci: 7 */
514 515
	{
		.sht		= &piix_sht,
T
Tejun Heo 已提交
516
		.flags		= PIIX_SATA_FLAGS | PIIX_FLAG_SCR |
517
				  PIIX_FLAG_AHCI,
518 519 520 521 522
		.pio_mask	= 0x1f,	/* pio0-4 */
		.mwdma_mask	= 0x07, /* mwdma0-2 */
		.udma_mask	= 0x7f,	/* udma0-6 */
		.port_ops	= &piix_sata_ops,
	},
523

524
	/* ich6m_sata_ahci: 8 */
525 526
	{
		.sht		= &piix_sht,
T
Tejun Heo 已提交
527
		.flags		= PIIX_SATA_FLAGS | PIIX_FLAG_SCR |
528
				  PIIX_FLAG_AHCI,
529 530 531 532 533
		.pio_mask	= 0x1f,	/* pio0-4 */
		.mwdma_mask	= 0x07, /* mwdma0-2 */
		.udma_mask	= 0x7f,	/* udma0-6 */
		.port_ops	= &piix_sata_ops,
	},
534

535
	/* ich8_sata_ahci: 9 */
536 537
	{
		.sht		= &piix_sht,
T
Tejun Heo 已提交
538
		.flags		= PIIX_SATA_FLAGS | PIIX_FLAG_SCR |
539 540 541 542 543 544
				  PIIX_FLAG_AHCI,
		.pio_mask	= 0x1f,	/* pio0-4 */
		.mwdma_mask	= 0x07, /* mwdma0-2 */
		.udma_mask	= 0x7f,	/* udma0-6 */
		.port_ops	= &piix_sata_ops,
	},
545

A
Alan 已提交
546 547 548 549 550 551 552 553
	/* piix_pata_mwdma: 10:  PIIX3 MWDMA only */
	{
		.sht		= &piix_sht,
		.flags		= PIIX_PATA_FLAGS,
		.pio_mask	= 0x1f,	/* pio0-4 */
		.mwdma_mask	= 0x06, /* mwdma1-2 ?? CHECK 0 should be ok but slow */
		.port_ops	= &piix_pata_ops,
	},
L
Linus Torvalds 已提交
554 555 556 557 558 559 560 561 562 563 564 565 566
};

static struct pci_bits piix_enable_bits[] = {
	{ 0x41U, 1U, 0x80UL, 0x80UL },	/* port 0 */
	{ 0x43U, 1U, 0x80UL, 0x80UL },	/* port 1 */
};

MODULE_AUTHOR("Andre Hedrick, Alan Cox, Andrzej Krzysztofowicz, Jeff Garzik");
MODULE_DESCRIPTION("SCSI low-level driver for Intel PIIX/ICH ATA controllers");
MODULE_LICENSE("GPL");
MODULE_DEVICE_TABLE(pci, piix_pci_tbl);
MODULE_VERSION(DRV_VERSION);

567 568 569 570 571 572 573 574 575 576 577 578 579
struct ich_laptop {
	u16 device;
	u16 subvendor;
	u16 subdevice;
};

/*
 *	List of laptops that use short cables rather than 80 wire
 */

static const struct ich_laptop ich_laptop[] = {
	/* devid, subvendor, subdev */
	{ 0x27DF, 0x0005, 0x0280 },	/* ICH7 on Acer 5602WLMi */
580
	{ 0x27DF, 0x1025, 0x0110 },	/* ICH7 on Acer 3682WLMi */
581
	{ 0x27DF, 0x1043, 0x1267 },	/* ICH7 on Asus W5F */
582 583 584 585
	/* end marker */
	{ 0, }
};

L
Linus Torvalds 已提交
586
/**
A
Alan Cox 已提交
587
 *	ich_pata_cable_detect - Probe host controller cable detect info
L
Linus Torvalds 已提交
588 589 590 591 592 593 594 595
 *	@ap: Port for which cable detect info is desired
 *
 *	Read 80c cable indicator from ATA PCI device's PCI config
 *	register.  This register is normally set by firmware (BIOS).
 *
 *	LOCKING:
 *	None (inherited from caller).
 */
596

A
Alan Cox 已提交
597
static int ich_pata_cable_detect(struct ata_port *ap)
L
Linus Torvalds 已提交
598
{
J
Jeff Garzik 已提交
599
	struct pci_dev *pdev = to_pci_dev(ap->host->dev);
600
	const struct ich_laptop *lap = &ich_laptop[0];
L
Linus Torvalds 已提交
601 602
	u8 tmp, mask;

603 604 605 606 607
	/* Check for specials - Acer Aspire 5602WLMi */
	while (lap->device) {
		if (lap->device == pdev->device &&
		    lap->subvendor == pdev->subsystem_vendor &&
		    lap->subdevice == pdev->subsystem_device) {
A
Alan Cox 已提交
608
			return ATA_CBL_PATA40_SHORT;
609 610 611 612
		}
		lap++;
	}

L
Linus Torvalds 已提交
613
	/* check BIOS cable detect results */
614
	mask = ap->port_no == 0 ? PIIX_80C_PRI : PIIX_80C_SEC;
L
Linus Torvalds 已提交
615 616
	pci_read_config_byte(pdev, PIIX_IOCFG, &tmp);
	if ((tmp & mask) == 0)
A
Alan Cox 已提交
617 618
		return ATA_CBL_PATA40;
	return ATA_CBL_PATA80;
L
Linus Torvalds 已提交
619 620 621
}

/**
622
 *	piix_pata_prereset - prereset for PATA host controller
623
 *	@ap: Target port
624
 *	@deadline: deadline jiffies for the operation
L
Linus Torvalds 已提交
625
 *
626 627 628
 *	LOCKING:
 *	None (inherited from caller).
 */
629
static int piix_pata_prereset(struct ata_port *ap, unsigned long deadline)
L
Linus Torvalds 已提交
630
{
J
Jeff Garzik 已提交
631
	struct pci_dev *pdev = to_pci_dev(ap->host->dev);
L
Linus Torvalds 已提交
632

633 634
	if (!pci_test_config_bits(pdev, &piix_enable_bits[ap->port_no]))
		return -ENOENT;
635
	return ata_std_prereset(ap, deadline);
636 637 638 639 640 641
}

static void piix_pata_error_handler(struct ata_port *ap)
{
	ata_bmdma_drive_eh(ap, piix_pata_prereset, ata_std_softreset, NULL,
			   ata_std_postreset);
L
Linus Torvalds 已提交
642 643
}

644 645
static void piix_sata_error_handler(struct ata_port *ap)
{
646
	ata_bmdma_drive_eh(ap, ata_std_prereset, ata_std_softreset, NULL,
647
			   ata_std_postreset);
L
Linus Torvalds 已提交
648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663
}

/**
 *	piix_set_piomode - Initialize host controller PATA PIO timings
 *	@ap: Port whose timings we are configuring
 *	@adev: um
 *
 *	Set PIO mode for device, in host controller PCI config space.
 *
 *	LOCKING:
 *	None (inherited from caller).
 */

static void piix_set_piomode (struct ata_port *ap, struct ata_device *adev)
{
	unsigned int pio	= adev->pio_mode - XFER_PIO_0;
J
Jeff Garzik 已提交
664
	struct pci_dev *dev	= to_pci_dev(ap->host->dev);
L
Linus Torvalds 已提交
665
	unsigned int is_slave	= (adev->devno != 0);
666
	unsigned int master_port= ap->port_no ? 0x42 : 0x40;
L
Linus Torvalds 已提交
667 668 669
	unsigned int slave_port	= 0x44;
	u16 master_data;
	u8 slave_data;
670 671
	u8 udma_enable;
	int control = 0;
672

673 674 675 676
	/*
	 *	See Intel Document 298600-004 for the timing programing rules
	 *	for ICH controllers.
	 */
L
Linus Torvalds 已提交
677 678 679 680 681 682 683 684

	static const	 /* ISP  RTC */
	u8 timings[][2]	= { { 0, 0 },
			    { 0, 0 },
			    { 1, 0 },
			    { 2, 1 },
			    { 2, 3 }, };

685 686 687 688 689
	if (pio >= 2)
		control |= 1;	/* TIME1 enable */
	if (ata_pio_need_iordy(adev))
		control |= 2;	/* IE enable */

690
	/* Intel specifies that the PPE functionality is for disk only */
691 692 693
	if (adev->class == ATA_DEV_ATA)
		control |= 4;	/* PPE enable */

L
Linus Torvalds 已提交
694 695
	pci_read_config_word(dev, master_port, &master_data);
	if (is_slave) {
696
		/* Enable SITRE (seperate slave timing register) */
L
Linus Torvalds 已提交
697
		master_data |= 0x4000;
698 699
		/* enable PPE1, IE1 and TIME1 as needed */
		master_data |= (control << 4);
L
Linus Torvalds 已提交
700
		pci_read_config_byte(dev, slave_port, &slave_data);
701
		slave_data &= (ap->port_no ? 0x0f : 0xf0);
702 703
		/* Load the timing nibble for this slave */
		slave_data |= ((timings[pio][0] << 2) | timings[pio][1]) << (ap->port_no ? 4 : 0);
L
Linus Torvalds 已提交
704
	} else {
705
		/* Master keeps the bits in a different format */
L
Linus Torvalds 已提交
706
		master_data &= 0xccf8;
707 708
		/* Enable PPE, IE and TIME as appropriate */
		master_data |= control;
L
Linus Torvalds 已提交
709 710 711 712 713 714 715
		master_data |=
			(timings[pio][0] << 12) |
			(timings[pio][1] << 8);
	}
	pci_write_config_word(dev, master_port, master_data);
	if (is_slave)
		pci_write_config_byte(dev, slave_port, slave_data);
716 717 718

	/* Ensure the UDMA bit is off - it will be turned back on if
	   UDMA is selected */
719

720 721 722 723 724
	if (ap->udma_mask) {
		pci_read_config_byte(dev, 0x48, &udma_enable);
		udma_enable &= ~(1 << (2 * ap->port_no + adev->devno));
		pci_write_config_byte(dev, 0x48, udma_enable);
	}
L
Linus Torvalds 已提交
725 726 727
}

/**
728
 *	do_pata_set_dmamode - Initialize host controller PATA PIO timings
L
Linus Torvalds 已提交
729
 *	@ap: Port whose timings we are configuring
730
 *	@adev: Drive in question
L
Linus Torvalds 已提交
731
 *	@udma: udma mode, 0 - 6
H
Henne 已提交
732
 *	@isich: set if the chip is an ICH device
L
Linus Torvalds 已提交
733 734 735 736 737 738 739
 *
 *	Set UDMA mode for device, in host controller PCI config space.
 *
 *	LOCKING:
 *	None (inherited from caller).
 */

740
static void do_pata_set_dmamode (struct ata_port *ap, struct ata_device *adev, int isich)
L
Linus Torvalds 已提交
741
{
J
Jeff Garzik 已提交
742
	struct pci_dev *dev	= to_pci_dev(ap->host->dev);
743 744 745 746
	u8 master_port		= ap->port_no ? 0x42 : 0x40;
	u16 master_data;
	u8 speed		= adev->dma_mode;
	int devid		= adev->devno + 2 * ap->port_no;
A
Andrew Morton 已提交
747
	u8 udma_enable		= 0;
748

749 750 751 752 753 754 755 756
	static const	 /* ISP  RTC */
	u8 timings[][2]	= { { 0, 0 },
			    { 0, 0 },
			    { 1, 0 },
			    { 2, 1 },
			    { 2, 3 }, };

	pci_read_config_word(dev, master_port, &master_data);
A
Alan 已提交
757 758
	if (ap->udma_mask)
		pci_read_config_byte(dev, 0x48, &udma_enable);
L
Linus Torvalds 已提交
759 760

	if (speed >= XFER_UDMA_0) {
761 762 763 764
		unsigned int udma = adev->dma_mode - XFER_UDMA_0;
		u16 udma_timing;
		u16 ideconf;
		int u_clock, u_speed;
765

766 767
		/*
	 	 * UDMA is handled by a combination of clock switching and
768 769
		 * selection of dividers
		 *
770
		 * Handy rule: Odd modes are UDMATIMx 01, even are 02
771
		 *	       except UDMA0 which is 00
772 773 774 775 776 777 778 779
		 */
		u_speed = min(2 - (udma & 1), udma);
		if (udma == 5)
			u_clock = 0x1000;	/* 100Mhz */
		else if (udma > 2)
			u_clock = 1;		/* 66Mhz */
		else
			u_clock = 0;		/* 33Mhz */
780

781
		udma_enable |= (1 << devid);
782

783 784 785 786 787 788
		/* Load the CT/RP selection */
		pci_read_config_word(dev, 0x4A, &udma_timing);
		udma_timing &= ~(3 << (4 * devid));
		udma_timing |= u_speed << (4 * devid);
		pci_write_config_word(dev, 0x4A, udma_timing);

789
		if (isich) {
790 791 792 793 794 795 796
			/* Select a 33/66/100Mhz clock */
			pci_read_config_word(dev, 0x54, &ideconf);
			ideconf &= ~(0x1001 << devid);
			ideconf |= u_clock << devid;
			/* For ICH or later we should set bit 10 for better
			   performance (WR_PingPong_En) */
			pci_write_config_word(dev, 0x54, ideconf);
L
Linus Torvalds 已提交
797 798
		}
	} else {
799 800 801 802 803 804 805 806 807 808 809 810
		/*
		 * MWDMA is driven by the PIO timings. We must also enable
		 * IORDY unconditionally along with TIME1. PPE has already
		 * been set when the PIO timing was set.
		 */
		unsigned int mwdma	= adev->dma_mode - XFER_MW_DMA_0;
		unsigned int control;
		u8 slave_data;
		const unsigned int needed_pio[3] = {
			XFER_PIO_0, XFER_PIO_3, XFER_PIO_4
		};
		int pio = needed_pio[mwdma] - XFER_PIO_0;
811

812
		control = 3;	/* IORDY|TIME1 */
813

814 815
		/* If the drive MWDMA is faster than it can do PIO then
		   we must force PIO into PIO0 */
816

817 818 819 820 821 822 823 824 825 826 827 828 829
		if (adev->pio_mode < needed_pio[mwdma])
			/* Enable DMA timing only */
			control |= 8;	/* PIO cycles in PIO0 */

		if (adev->devno) {	/* Slave */
			master_data &= 0xFF4F;  /* Mask out IORDY|TIME1|DMAONLY */
			master_data |= control << 4;
			pci_read_config_byte(dev, 0x44, &slave_data);
			slave_data &= (0x0F + 0xE1 * ap->port_no);
			/* Load the matching timing */
			slave_data |= ((timings[pio][0] << 2) | timings[pio][1]) << (ap->port_no ? 4 : 0);
			pci_write_config_byte(dev, 0x44, slave_data);
		} else { 	/* Master */
830
			master_data &= 0xCCF4;	/* Mask out IORDY|TIME1|DMAONLY
831 832 833 834 835 836 837 838
						   and master timing bits */
			master_data |= control;
			master_data |=
				(timings[pio][0] << 12) |
				(timings[pio][1] << 8);
		}
		udma_enable &= ~(1 << devid);
		pci_write_config_word(dev, master_port, master_data);
L
Linus Torvalds 已提交
839
	}
840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874
	/* Don't scribble on 0x48 if the controller does not support UDMA */
	if (ap->udma_mask)
		pci_write_config_byte(dev, 0x48, udma_enable);
}

/**
 *	piix_set_dmamode - Initialize host controller PATA DMA timings
 *	@ap: Port whose timings we are configuring
 *	@adev: um
 *
 *	Set MW/UDMA mode for device, in host controller PCI config space.
 *
 *	LOCKING:
 *	None (inherited from caller).
 */

static void piix_set_dmamode (struct ata_port *ap, struct ata_device *adev)
{
	do_pata_set_dmamode(ap, adev, 0);
}

/**
 *	ich_set_dmamode - Initialize host controller PATA DMA timings
 *	@ap: Port whose timings we are configuring
 *	@adev: um
 *
 *	Set MW/UDMA mode for device, in host controller PCI config space.
 *
 *	LOCKING:
 *	None (inherited from caller).
 */

static void ich_set_dmamode (struct ata_port *ap, struct ata_device *adev)
{
	do_pata_set_dmamode(ap, adev, 1);
L
Linus Torvalds 已提交
875 876 877 878 879 880 881
}

#define AHCI_PCI_BAR 5
#define AHCI_GLOBAL_CTL 0x04
#define AHCI_ENABLE (1 << 31)
static int piix_disable_ahci(struct pci_dev *pdev)
{
882
	void __iomem *mmio;
L
Linus Torvalds 已提交
883 884 885 886 887 888 889
	u32 tmp;
	int rc = 0;

	/* BUG: pci_enable_device has not yet been called.  This
	 * works because this device is usually set up by BIOS.
	 */

890 891
	if (!pci_resource_start(pdev, AHCI_PCI_BAR) ||
	    !pci_resource_len(pdev, AHCI_PCI_BAR))
L
Linus Torvalds 已提交
892
		return 0;
893

894
	mmio = pci_iomap(pdev, AHCI_PCI_BAR, 64);
L
Linus Torvalds 已提交
895 896
	if (!mmio)
		return -ENOMEM;
897

L
Linus Torvalds 已提交
898 899 900 901 902 903 904 905 906
	tmp = readl(mmio + AHCI_GLOBAL_CTL);
	if (tmp & AHCI_ENABLE) {
		tmp &= ~AHCI_ENABLE;
		writel(tmp, mmio + AHCI_GLOBAL_CTL);

		tmp = readl(mmio + AHCI_GLOBAL_CTL);
		if (tmp & AHCI_ENABLE)
			rc = -EIO;
	}
907

908
	pci_iounmap(pdev, mmio);
L
Linus Torvalds 已提交
909 910 911
	return rc;
}

A
Alan Cox 已提交
912 913
/**
 *	piix_check_450nx_errata	-	Check for problem 450NX setup
914
 *	@ata_dev: the PCI device to check
915
 *
A
Alan Cox 已提交
916 917 918 919 920 921 922 923 924 925
 *	Check for the present of 450NX errata #19 and errata #25. If
 *	they are found return an error code so we can turn off DMA
 */

static int __devinit piix_check_450nx_errata(struct pci_dev *ata_dev)
{
	struct pci_dev *pdev = NULL;
	u16 cfg;
	u8 rev;
	int no_piix_dma = 0;
926

A
Alan Cox 已提交
927 928 929 930 931 932 933
	while((pdev = pci_get_device(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82454NX, pdev)) != NULL)
	{
		/* Look for 450NX PXB. Check for problem configurations
		   A PCI quirk checks bit 6 already */
		pci_read_config_byte(pdev, PCI_REVISION_ID, &rev);
		pci_read_config_word(pdev, 0x41, &cfg);
		/* Only on the original revision: IDE DMA can hang */
A
Alan Cox 已提交
934
		if (rev == 0x00)
A
Alan Cox 已提交
935 936
			no_piix_dma = 1;
		/* On all revisions below 5 PXB bus lock must be disabled for IDE */
A
Alan Cox 已提交
937
		else if (cfg & (1<<14) && rev < 5)
A
Alan Cox 已提交
938 939
			no_piix_dma = 2;
	}
A
Alan Cox 已提交
940
	if (no_piix_dma)
A
Alan Cox 已提交
941
		dev_printk(KERN_WARNING, &ata_dev->dev, "450NX errata present, disabling IDE DMA.\n");
A
Alan Cox 已提交
942
	if (no_piix_dma == 2)
A
Alan Cox 已提交
943 944
		dev_printk(KERN_WARNING, &ata_dev->dev, "A BIOS update may resolve this.\n");
	return no_piix_dma;
945
}
A
Alan Cox 已提交
946

947
static void __devinit piix_init_pcs(struct pci_dev *pdev,
948
				    struct ata_port_info *pinfo,
949 950 951 952 953 954 955 956 957 958 959 960 961 962 963
				    const struct piix_map_db *map_db)
{
	u16 pcs, new_pcs;

	pci_read_config_word(pdev, ICH5_PCS, &pcs);

	new_pcs = pcs | map_db->port_enable;

	if (new_pcs != pcs) {
		DPRINTK("updating PCS from 0x%x to 0x%x\n", pcs, new_pcs);
		pci_write_config_word(pdev, ICH5_PCS, new_pcs);
		msleep(150);
	}
}

964
static void __devinit piix_init_sata_map(struct pci_dev *pdev,
965 966
					 struct ata_port_info *pinfo,
					 const struct piix_map_db *map_db)
967
{
968
	struct piix_host_priv *hpriv = pinfo[0].private_data;
969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984 985 986 987 988 989 990
	const unsigned int *map;
	int i, invalid_map = 0;
	u8 map_value;

	pci_read_config_byte(pdev, ICH5_PMR, &map_value);

	map = map_db->map[map_value & map_db->mask];

	dev_printk(KERN_INFO, &pdev->dev, "MAP [");
	for (i = 0; i < 4; i++) {
		switch (map[i]) {
		case RV:
			invalid_map = 1;
			printk(" XX");
			break;

		case NA:
			printk(" --");
			break;

		case IDE:
			WARN_ON((i & 1) || map[i + 1] != IDE);
991
			pinfo[i / 2] = piix_port_info[ich_pata_100];
992
			pinfo[i / 2].private_data = hpriv;
993 994 995 996 997 998 999
			i++;
			printk(" IDE IDE");
			break;

		default:
			printk(" P%d", map[i]);
			if (i & 1)
J
Jeff Garzik 已提交
1000
				pinfo[i / 2].flags |= ATA_FLAG_SLAVE_POSS;
1001 1002 1003 1004 1005 1006 1007 1008 1009
			break;
		}
	}
	printk(" ]\n");

	if (invalid_map)
		dev_printk(KERN_ERR, &pdev->dev,
			   "invalid MAP value %u\n", map_value);

1010
	hpriv->map = map;
1011 1012
}

L
Linus Torvalds 已提交
1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030
/**
 *	piix_init_one - Register PIIX ATA PCI device with kernel services
 *	@pdev: PCI device to register
 *	@ent: Entry in piix_pci_tbl matching with @pdev
 *
 *	Called from kernel PCI layer.  We probe for combined mode (sigh),
 *	and then hand over control to libata, for it to do the rest.
 *
 *	LOCKING:
 *	Inherited from PCI layer (may sleep).
 *
 *	RETURNS:
 *	Zero on success, or -ERRNO value.
 */

static int piix_init_one (struct pci_dev *pdev, const struct pci_device_id *ent)
{
	static int printed_version;
1031
	struct device *dev = &pdev->dev;
1032 1033
	struct ata_port_info port_info[2];
	struct ata_port_info *ppinfo[2] = { &port_info[0], &port_info[1] };
1034
	struct piix_host_priv *hpriv;
J
Jeff Garzik 已提交
1035
	unsigned long port_flags;
L
Linus Torvalds 已提交
1036 1037

	if (!printed_version++)
1038 1039
		dev_printk(KERN_DEBUG, &pdev->dev,
			   "version " DRV_VERSION "\n");
L
Linus Torvalds 已提交
1040 1041 1042 1043 1044

	/* no hotplugging support (FIXME) */
	if (!in_module_init)
		return -ENODEV;

1045
	hpriv = devm_kzalloc(dev, sizeof(*hpriv), GFP_KERNEL);
1046 1047 1048
	if (!hpriv)
		return -ENOMEM;

1049 1050
	port_info[0] = piix_port_info[ent->driver_data];
	port_info[1] = piix_port_info[ent->driver_data];
1051 1052
	port_info[0].private_data = hpriv;
	port_info[1].private_data = hpriv;
L
Linus Torvalds 已提交
1053

J
Jeff Garzik 已提交
1054
	port_flags = port_info[0].flags;
1055

J
Jeff Garzik 已提交
1056
	if (port_flags & PIIX_FLAG_AHCI) {
J
Jeff Garzik 已提交
1057 1058 1059 1060 1061 1062 1063
		u8 tmp;
		pci_read_config_byte(pdev, PIIX_SCC, &tmp);
		if (tmp == PIIX_AHCI_DEVICE) {
			int rc = piix_disable_ahci(pdev);
			if (rc)
				return rc;
		}
L
Linus Torvalds 已提交
1064 1065
	}

1066
	/* Initialize SATA map */
J
Jeff Garzik 已提交
1067
	if (port_flags & ATA_FLAG_SATA) {
1068 1069
		piix_init_sata_map(pdev, port_info,
				   piix_map_db_table[ent->driver_data]);
1070 1071
		piix_init_pcs(pdev, port_info,
			      piix_map_db_table[ent->driver_data]);
1072
	}
L
Linus Torvalds 已提交
1073 1074 1075 1076 1077 1078 1079

	/* On ICH5, some BIOSen disable the interrupt using the
	 * PCI_COMMAND_INTX_DISABLE bit added in PCI 2.3.
	 * On ICH6, this bit has the same effect, but only when
	 * MSI is disabled (and it is disabled, as we don't use
	 * message-signalled interrupts currently).
	 */
J
Jeff Garzik 已提交
1080
	if (port_flags & PIIX_FLAG_CHECKINTR)
B
Brett M Russ 已提交
1081
		pci_intx(pdev, 1);
L
Linus Torvalds 已提交
1082

A
Alan Cox 已提交
1083 1084 1085 1086
	if (piix_check_450nx_errata(pdev)) {
		/* This writes into the master table but it does not
		   really matter for this errata as we will apply it to
		   all the PIIX devices on the board */
1087 1088 1089 1090
		port_info[0].mwdma_mask = 0;
		port_info[0].udma_mask = 0;
		port_info[1].mwdma_mask = 0;
		port_info[1].udma_mask = 0;
A
Alan Cox 已提交
1091
	}
1092
	return ata_pci_init_one(pdev, ppinfo, 2);
L
Linus Torvalds 已提交
1093 1094 1095 1096 1097 1098
}

static int __init piix_init(void)
{
	int rc;

1099 1100
	DPRINTK("pci_register_driver\n");
	rc = pci_register_driver(&piix_pci_driver);
L
Linus Torvalds 已提交
1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116
	if (rc)
		return rc;

	in_module_init = 0;

	DPRINTK("done\n");
	return 0;
}

static void __exit piix_exit(void)
{
	pci_unregister_driver(&piix_pci_driver);
}

module_init(piix_init);
module_exit(piix_exit);