| /* | 
 |  *    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 | 
 |  * | 
 |  * | 
 |  *  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/ | 
 |  * | 
 |  * Documentation | 
 |  *	Publicly available from Intel web site. Errata documentation | 
 |  * is also publicly available. As an aide to anyone hacking on this | 
 |  * driver the list of errata that are relevant is below, going back to | 
 |  * PIIX4. Older device documentation is now a bit tricky to find. | 
 |  * | 
 |  * The chipsets all follow very much the same design. The original Triton | 
 |  * series chipsets do _not_ support independent 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 independent 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 | 
 |  *	ICH7	errata #16	- MWDMA1 timings are incorrect | 
 |  * | 
 |  * 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 | 
 |  */ | 
 |  | 
 | #include <linux/kernel.h> | 
 | #include <linux/module.h> | 
 | #include <linux/pci.h> | 
 | #include <linux/init.h> | 
 | #include <linux/blkdev.h> | 
 | #include <linux/delay.h> | 
 | #include <linux/device.h> | 
 | #include <linux/gfp.h> | 
 | #include <scsi/scsi_host.h> | 
 | #include <linux/libata.h> | 
 | #include <linux/dmi.h> | 
 |  | 
 | #define DRV_NAME	"ata_piix" | 
 | #define DRV_VERSION	"2.13" | 
 |  | 
 | enum { | 
 | 	PIIX_IOCFG		= 0x54, /* IDE I/O configuration register */ | 
 | 	ICH5_PMR		= 0x90, /* port mapping register */ | 
 | 	ICH5_PCS		= 0x92,	/* port control and status */ | 
 | 	PIIX_SIDPR_BAR		= 5, | 
 | 	PIIX_SIDPR_LEN		= 16, | 
 | 	PIIX_SIDPR_IDX		= 0, | 
 | 	PIIX_SIDPR_DATA		= 4, | 
 |  | 
 | 	PIIX_FLAG_CHECKINTR	= (1 << 28), /* make sure PCI INTx enabled */ | 
 | 	PIIX_FLAG_SIDPR		= (1 << 29), /* SATA idx/data pair regs */ | 
 |  | 
 | 	PIIX_PATA_FLAGS		= ATA_FLAG_SLAVE_POSS, | 
 | 	PIIX_SATA_FLAGS		= ATA_FLAG_SATA | PIIX_FLAG_CHECKINTR, | 
 |  | 
 | 	PIIX_80C_PRI		= (1 << 5) | (1 << 4), | 
 | 	PIIX_80C_SEC		= (1 << 7) | (1 << 6), | 
 |  | 
 | 	/* 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 available */ | 
 | 	RV			= -3, /* reserved */ | 
 |  | 
 | 	PIIX_AHCI_DEVICE	= 6, | 
 |  | 
 | 	/* host->flags bits */ | 
 | 	PIIX_HOST_BROKEN_SUSPEND = (1 << 24), | 
 | }; | 
 |  | 
 | enum piix_controller_ids { | 
 | 	/* controller IDs */ | 
 | 	piix_pata_mwdma,	/* PIIX3 MWDMA only */ | 
 | 	piix_pata_33,		/* PIIX4 at 33Mhz */ | 
 | 	ich_pata_33,		/* ICH up to UDMA 33 only */ | 
 | 	ich_pata_66,		/* ICH up to 66 Mhz */ | 
 | 	ich_pata_100,		/* ICH up to UDMA 100 */ | 
 | 	ich_pata_100_nomwdma1,	/* ICH up to UDMA 100 but with no MWDMA1*/ | 
 | 	ich5_sata, | 
 | 	ich6_sata, | 
 | 	ich6m_sata, | 
 | 	ich8_sata, | 
 | 	ich8_2port_sata, | 
 | 	ich8m_apple_sata,	/* locks up on second port enable */ | 
 | 	tolapai_sata, | 
 | 	piix_pata_vmw,			/* PIIX4 for VMware, spurious DMA_ERR */ | 
 | }; | 
 |  | 
 | struct piix_map_db { | 
 | 	const u32 mask; | 
 | 	const u16 port_enable; | 
 | 	const int map[][4]; | 
 | }; | 
 |  | 
 | struct piix_host_priv { | 
 | 	const int *map; | 
 | 	u32 saved_iocfg; | 
 | 	void __iomem *sidpr; | 
 | }; | 
 |  | 
 | static int piix_init_one(struct pci_dev *pdev, | 
 | 			 const struct pci_device_id *ent); | 
 | static void piix_remove_one(struct pci_dev *pdev); | 
 | static int piix_pata_prereset(struct ata_link *link, unsigned long deadline); | 
 | 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); | 
 | static int ich_pata_cable_detect(struct ata_port *ap); | 
 | static u8 piix_vmw_bmdma_status(struct ata_port *ap); | 
 | static int piix_sidpr_scr_read(struct ata_link *link, | 
 | 			       unsigned int reg, u32 *val); | 
 | static int piix_sidpr_scr_write(struct ata_link *link, | 
 | 				unsigned int reg, u32 val); | 
 | static int piix_sidpr_set_lpm(struct ata_link *link, enum ata_lpm_policy policy, | 
 | 			      unsigned hints); | 
 | static bool piix_irq_check(struct ata_port *ap); | 
 | #ifdef CONFIG_PM | 
 | static int piix_pci_device_suspend(struct pci_dev *pdev, pm_message_t mesg); | 
 | static int piix_pci_device_resume(struct pci_dev *pdev); | 
 | #endif | 
 |  | 
 | static unsigned int in_module_init = 1; | 
 |  | 
 | static const struct pci_device_id piix_pci_tbl[] = { | 
 | 	/* Intel PIIX3 for the 430HX etc */ | 
 | 	{ 0x8086, 0x7010, PCI_ANY_ID, PCI_ANY_ID, 0, 0, piix_pata_mwdma }, | 
 | 	/* VMware ICH4 */ | 
 | 	{ 0x8086, 0x7111, 0x15ad, 0x1976, 0, 0, piix_pata_vmw }, | 
 | 	/* 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-L */ | 
 | 	{ 0x8086, 0x24C1, 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_100 }, | 
 | 	/* C-ICH (i810E2) */ | 
 | 	{ 0x8086, 0x245B, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_100 }, | 
 | 	/* ESB (855GME/875P + 6300ESB) UDMA 100  */ | 
 | 	{ 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_100_nomwdma1 }, | 
 | 	{ 0x8086, 0x269E, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_100_nomwdma1 }, | 
 | 	/* ICH8 Mobile PATA Controller */ | 
 | 	{ 0x8086, 0x2850, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_100 }, | 
 |  | 
 | 	/* SATA ports */ | 
 |  | 
 | 	/* 82801EB (ICH5) */ | 
 | 	{ 0x8086, 0x24d1, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich5_sata }, | 
 | 	/* 82801EB (ICH5) */ | 
 | 	{ 0x8086, 0x24df, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich5_sata }, | 
 | 	/* 6300ESB (ICH5 variant with broken PCS present bits) */ | 
 | 	{ 0x8086, 0x25a3, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich5_sata }, | 
 | 	/* 6300ESB pretending RAID */ | 
 | 	{ 0x8086, 0x25b0, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich5_sata }, | 
 | 	/* 82801FB/FW (ICH6/ICH6W) */ | 
 | 	{ 0x8086, 0x2651, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich6_sata }, | 
 | 	/* 82801FR/FRW (ICH6R/ICH6RW) */ | 
 | 	{ 0x8086, 0x2652, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich6_sata }, | 
 | 	/* 82801FBM ICH6M (ICH6R with only port 0 and 2 implemented). | 
 | 	 * Attach iff the controller is in IDE mode. */ | 
 | 	{ 0x8086, 0x2653, PCI_ANY_ID, PCI_ANY_ID, | 
 | 	  PCI_CLASS_STORAGE_IDE << 8, 0xffff00, ich6m_sata }, | 
 | 	/* 82801GB/GR/GH (ICH7, identical to ICH6) */ | 
 | 	{ 0x8086, 0x27c0, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich6_sata }, | 
 | 	/* 2801GBM/GHM (ICH7M, identical to ICH6M) */ | 
 | 	{ 0x8086, 0x27c4, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich6m_sata }, | 
 | 	/* Enterprise Southbridge 2 (631xESB/632xESB) */ | 
 | 	{ 0x8086, 0x2680, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich6_sata }, | 
 | 	/* SATA Controller 1 IDE (ICH8) */ | 
 | 	{ 0x8086, 0x2820, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata }, | 
 | 	/* SATA Controller 2 IDE (ICH8) */ | 
 | 	{ 0x8086, 0x2825, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata }, | 
 | 	/* Mobile SATA Controller IDE (ICH8M), Apple */ | 
 | 	{ 0x8086, 0x2828, 0x106b, 0x00a0, 0, 0, ich8m_apple_sata }, | 
 | 	{ 0x8086, 0x2828, 0x106b, 0x00a1, 0, 0, ich8m_apple_sata }, | 
 | 	{ 0x8086, 0x2828, 0x106b, 0x00a3, 0, 0, ich8m_apple_sata }, | 
 | 	/* Mobile SATA Controller IDE (ICH8M) */ | 
 | 	{ 0x8086, 0x2828, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata }, | 
 | 	/* SATA Controller IDE (ICH9) */ | 
 | 	{ 0x8086, 0x2920, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata }, | 
 | 	/* SATA Controller IDE (ICH9) */ | 
 | 	{ 0x8086, 0x2921, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata }, | 
 | 	/* SATA Controller IDE (ICH9) */ | 
 | 	{ 0x8086, 0x2926, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata }, | 
 | 	/* SATA Controller IDE (ICH9M) */ | 
 | 	{ 0x8086, 0x2928, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata }, | 
 | 	/* SATA Controller IDE (ICH9M) */ | 
 | 	{ 0x8086, 0x292d, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata }, | 
 | 	/* SATA Controller IDE (ICH9M) */ | 
 | 	{ 0x8086, 0x292e, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata }, | 
 | 	/* SATA Controller IDE (Tolapai) */ | 
 | 	{ 0x8086, 0x5028, PCI_ANY_ID, PCI_ANY_ID, 0, 0, tolapai_sata }, | 
 | 	/* SATA Controller IDE (ICH10) */ | 
 | 	{ 0x8086, 0x3a00, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata }, | 
 | 	/* SATA Controller IDE (ICH10) */ | 
 | 	{ 0x8086, 0x3a06, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata }, | 
 | 	/* SATA Controller IDE (ICH10) */ | 
 | 	{ 0x8086, 0x3a20, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata }, | 
 | 	/* SATA Controller IDE (ICH10) */ | 
 | 	{ 0x8086, 0x3a26, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata }, | 
 | 	/* SATA Controller IDE (PCH) */ | 
 | 	{ 0x8086, 0x3b20, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata }, | 
 | 	/* SATA Controller IDE (PCH) */ | 
 | 	{ 0x8086, 0x3b21, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata }, | 
 | 	/* SATA Controller IDE (PCH) */ | 
 | 	{ 0x8086, 0x3b26, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata }, | 
 | 	/* SATA Controller IDE (PCH) */ | 
 | 	{ 0x8086, 0x3b28, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata }, | 
 | 	/* SATA Controller IDE (PCH) */ | 
 | 	{ 0x8086, 0x3b2d, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata }, | 
 | 	/* SATA Controller IDE (PCH) */ | 
 | 	{ 0x8086, 0x3b2e, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata }, | 
 | 	/* SATA Controller IDE (CPT) */ | 
 | 	{ 0x8086, 0x1c00, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata }, | 
 | 	/* SATA Controller IDE (CPT) */ | 
 | 	{ 0x8086, 0x1c01, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata }, | 
 | 	/* SATA Controller IDE (CPT) */ | 
 | 	{ 0x8086, 0x1c08, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata }, | 
 | 	/* SATA Controller IDE (CPT) */ | 
 | 	{ 0x8086, 0x1c09, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata }, | 
 | 	/* SATA Controller IDE (PBG) */ | 
 | 	{ 0x8086, 0x1d00, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata }, | 
 | 	/* SATA Controller IDE (PBG) */ | 
 | 	{ 0x8086, 0x1d08, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata }, | 
 | 	/* SATA Controller IDE (Panther Point) */ | 
 | 	{ 0x8086, 0x1e00, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata }, | 
 | 	/* SATA Controller IDE (Panther Point) */ | 
 | 	{ 0x8086, 0x1e01, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata }, | 
 | 	/* SATA Controller IDE (Panther Point) */ | 
 | 	{ 0x8086, 0x1e08, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata }, | 
 | 	/* SATA Controller IDE (Panther Point) */ | 
 | 	{ 0x8086, 0x1e09, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata }, | 
 | 	{ }	/* terminate list */ | 
 | }; | 
 |  | 
 | static struct pci_driver piix_pci_driver = { | 
 | 	.name			= DRV_NAME, | 
 | 	.id_table		= piix_pci_tbl, | 
 | 	.probe			= piix_init_one, | 
 | 	.remove			= piix_remove_one, | 
 | #ifdef CONFIG_PM | 
 | 	.suspend		= piix_pci_device_suspend, | 
 | 	.resume			= piix_pci_device_resume, | 
 | #endif | 
 | }; | 
 |  | 
 | static struct scsi_host_template piix_sht = { | 
 | 	ATA_BMDMA_SHT(DRV_NAME), | 
 | }; | 
 |  | 
 | static struct ata_port_operations piix_sata_ops = { | 
 | 	.inherits		= &ata_bmdma32_port_ops, | 
 | 	.sff_irq_check		= piix_irq_check, | 
 | }; | 
 |  | 
 | static struct ata_port_operations piix_pata_ops = { | 
 | 	.inherits		= &piix_sata_ops, | 
 | 	.cable_detect		= ata_cable_40wire, | 
 | 	.set_piomode		= piix_set_piomode, | 
 | 	.set_dmamode		= piix_set_dmamode, | 
 | 	.prereset		= piix_pata_prereset, | 
 | }; | 
 |  | 
 | static struct ata_port_operations piix_vmw_ops = { | 
 | 	.inherits		= &piix_pata_ops, | 
 | 	.bmdma_status		= piix_vmw_bmdma_status, | 
 | }; | 
 |  | 
 | static struct ata_port_operations ich_pata_ops = { | 
 | 	.inherits		= &piix_pata_ops, | 
 | 	.cable_detect		= ich_pata_cable_detect, | 
 | 	.set_dmamode		= ich_set_dmamode, | 
 | }; | 
 |  | 
 | static struct device_attribute *piix_sidpr_shost_attrs[] = { | 
 | 	&dev_attr_link_power_management_policy, | 
 | 	NULL | 
 | }; | 
 |  | 
 | static struct scsi_host_template piix_sidpr_sht = { | 
 | 	ATA_BMDMA_SHT(DRV_NAME), | 
 | 	.shost_attrs		= piix_sidpr_shost_attrs, | 
 | }; | 
 |  | 
 | static struct ata_port_operations piix_sidpr_sata_ops = { | 
 | 	.inherits		= &piix_sata_ops, | 
 | 	.hardreset		= sata_std_hardreset, | 
 | 	.scr_read		= piix_sidpr_scr_read, | 
 | 	.scr_write		= piix_sidpr_scr_write, | 
 | 	.set_lpm		= piix_sidpr_set_lpm, | 
 | }; | 
 |  | 
 | static const struct piix_map_db ich5_map_db = { | 
 | 	.mask = 0x7, | 
 | 	.port_enable = 0x3, | 
 | 	.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 */ | 
 | 	}, | 
 | }; | 
 |  | 
 | static const struct piix_map_db ich6_map_db = { | 
 | 	.mask = 0x3, | 
 | 	.port_enable = 0xf, | 
 | 	.map = { | 
 | 		/* PM   PS   SM   SS       MAP */ | 
 | 		{  P0,  P2,  P1,  P3 }, /* 00b */ | 
 | 		{ IDE, IDE,  P1,  P3 }, /* 01b */ | 
 | 		{  P0,  P2, IDE, IDE }, /* 10b */ | 
 | 		{  RV,  RV,  RV,  RV }, | 
 | 	}, | 
 | }; | 
 |  | 
 | static const struct piix_map_db ich6m_map_db = { | 
 | 	.mask = 0x3, | 
 | 	.port_enable = 0x5, | 
 |  | 
 | 	/* Map 01b isn't specified in the doc but some notebooks use | 
 | 	 * it anyway.  MAP 01b have been spotted on both ICH6M and | 
 | 	 * ICH7M. | 
 | 	 */ | 
 | 	.map = { | 
 | 		/* PM   PS   SM   SS       MAP */ | 
 | 		{  P0,  P2,  NA,  NA }, /* 00b */ | 
 | 		{ IDE, IDE,  P1,  P3 }, /* 01b */ | 
 | 		{  P0,  P2, IDE, IDE }, /* 10b */ | 
 | 		{  RV,  RV,  RV,  RV }, | 
 | 	}, | 
 | }; | 
 |  | 
 | static const struct piix_map_db ich8_map_db = { | 
 | 	.mask = 0x3, | 
 | 	.port_enable = 0xf, | 
 | 	.map = { | 
 | 		/* PM   PS   SM   SS       MAP */ | 
 | 		{  P0,  P2,  P1,  P3 }, /* 00b (hardwired when in AHCI) */ | 
 | 		{  RV,  RV,  RV,  RV }, | 
 | 		{  P0,  P2, IDE, IDE }, /* 10b (IDE mode) */ | 
 | 		{  RV,  RV,  RV,  RV }, | 
 | 	}, | 
 | }; | 
 |  | 
 | static const struct piix_map_db ich8_2port_map_db = { | 
 | 	.mask = 0x3, | 
 | 	.port_enable = 0x3, | 
 | 	.map = { | 
 | 		/* PM   PS   SM   SS       MAP */ | 
 | 		{  P0,  NA,  P1,  NA }, /* 00b */ | 
 | 		{  RV,  RV,  RV,  RV }, /* 01b */ | 
 | 		{  RV,  RV,  RV,  RV }, /* 10b */ | 
 | 		{  RV,  RV,  RV,  RV }, | 
 | 	}, | 
 | }; | 
 |  | 
 | static const struct piix_map_db ich8m_apple_map_db = { | 
 | 	.mask = 0x3, | 
 | 	.port_enable = 0x1, | 
 | 	.map = { | 
 | 		/* PM   PS   SM   SS       MAP */ | 
 | 		{  P0,  NA,  NA,  NA }, /* 00b */ | 
 | 		{  RV,  RV,  RV,  RV }, | 
 | 		{  P0,  P2, IDE, IDE }, /* 10b */ | 
 | 		{  RV,  RV,  RV,  RV }, | 
 | 	}, | 
 | }; | 
 |  | 
 | static const struct piix_map_db tolapai_map_db = { | 
 | 	.mask = 0x3, | 
 | 	.port_enable = 0x3, | 
 | 	.map = { | 
 | 		/* PM   PS   SM   SS       MAP */ | 
 | 		{  P0,  NA,  P1,  NA }, /* 00b */ | 
 | 		{  RV,  RV,  RV,  RV }, /* 01b */ | 
 | 		{  RV,  RV,  RV,  RV }, /* 10b */ | 
 | 		{  RV,  RV,  RV,  RV }, | 
 | 	}, | 
 | }; | 
 |  | 
 | static const struct piix_map_db *piix_map_db_table[] = { | 
 | 	[ich5_sata]		= &ich5_map_db, | 
 | 	[ich6_sata]		= &ich6_map_db, | 
 | 	[ich6m_sata]		= &ich6m_map_db, | 
 | 	[ich8_sata]		= &ich8_map_db, | 
 | 	[ich8_2port_sata]	= &ich8_2port_map_db, | 
 | 	[ich8m_apple_sata]	= &ich8m_apple_map_db, | 
 | 	[tolapai_sata]		= &tolapai_map_db, | 
 | }; | 
 |  | 
 | static struct ata_port_info piix_port_info[] = { | 
 | 	[piix_pata_mwdma] = 	/* PIIX3 MWDMA only */ | 
 | 	{ | 
 | 		.flags		= PIIX_PATA_FLAGS, | 
 | 		.pio_mask	= ATA_PIO4, | 
 | 		.mwdma_mask	= ATA_MWDMA12_ONLY, /* mwdma1-2 ?? CHECK 0 should be ok but slow */ | 
 | 		.port_ops	= &piix_pata_ops, | 
 | 	}, | 
 |  | 
 | 	[piix_pata_33] =	/* PIIX4 at 33MHz */ | 
 | 	{ | 
 | 		.flags		= PIIX_PATA_FLAGS, | 
 | 		.pio_mask	= ATA_PIO4, | 
 | 		.mwdma_mask	= ATA_MWDMA12_ONLY, /* mwdma1-2 ?? CHECK 0 should be ok but slow */ | 
 | 		.udma_mask	= ATA_UDMA2, | 
 | 		.port_ops	= &piix_pata_ops, | 
 | 	}, | 
 |  | 
 | 	[ich_pata_33] = 	/* ICH0 - ICH at 33Mhz*/ | 
 | 	{ | 
 | 		.flags		= PIIX_PATA_FLAGS, | 
 | 		.pio_mask 	= ATA_PIO4, | 
 | 		.mwdma_mask	= ATA_MWDMA12_ONLY, /* Check: maybe MWDMA0 is ok  */ | 
 | 		.udma_mask	= ATA_UDMA2, | 
 | 		.port_ops	= &ich_pata_ops, | 
 | 	}, | 
 |  | 
 | 	[ich_pata_66] = 	/* ICH controllers up to 66MHz */ | 
 | 	{ | 
 | 		.flags		= PIIX_PATA_FLAGS, | 
 | 		.pio_mask 	= ATA_PIO4, | 
 | 		.mwdma_mask	= ATA_MWDMA12_ONLY, /* MWDMA0 is broken on chip */ | 
 | 		.udma_mask	= ATA_UDMA4, | 
 | 		.port_ops	= &ich_pata_ops, | 
 | 	}, | 
 |  | 
 | 	[ich_pata_100] = | 
 | 	{ | 
 | 		.flags		= PIIX_PATA_FLAGS | PIIX_FLAG_CHECKINTR, | 
 | 		.pio_mask	= ATA_PIO4, | 
 | 		.mwdma_mask	= ATA_MWDMA12_ONLY, | 
 | 		.udma_mask	= ATA_UDMA5, | 
 | 		.port_ops	= &ich_pata_ops, | 
 | 	}, | 
 |  | 
 | 	[ich_pata_100_nomwdma1] = | 
 | 	{ | 
 | 		.flags		= PIIX_PATA_FLAGS | PIIX_FLAG_CHECKINTR, | 
 | 		.pio_mask	= ATA_PIO4, | 
 | 		.mwdma_mask	= ATA_MWDMA2_ONLY, | 
 | 		.udma_mask	= ATA_UDMA5, | 
 | 		.port_ops	= &ich_pata_ops, | 
 | 	}, | 
 |  | 
 | 	[ich5_sata] = | 
 | 	{ | 
 | 		.flags		= PIIX_SATA_FLAGS, | 
 | 		.pio_mask	= ATA_PIO4, | 
 | 		.mwdma_mask	= ATA_MWDMA2, | 
 | 		.udma_mask	= ATA_UDMA6, | 
 | 		.port_ops	= &piix_sata_ops, | 
 | 	}, | 
 |  | 
 | 	[ich6_sata] = | 
 | 	{ | 
 | 		.flags		= PIIX_SATA_FLAGS, | 
 | 		.pio_mask	= ATA_PIO4, | 
 | 		.mwdma_mask	= ATA_MWDMA2, | 
 | 		.udma_mask	= ATA_UDMA6, | 
 | 		.port_ops	= &piix_sata_ops, | 
 | 	}, | 
 |  | 
 | 	[ich6m_sata] = | 
 | 	{ | 
 | 		.flags		= PIIX_SATA_FLAGS, | 
 | 		.pio_mask	= ATA_PIO4, | 
 | 		.mwdma_mask	= ATA_MWDMA2, | 
 | 		.udma_mask	= ATA_UDMA6, | 
 | 		.port_ops	= &piix_sata_ops, | 
 | 	}, | 
 |  | 
 | 	[ich8_sata] = | 
 | 	{ | 
 | 		.flags		= PIIX_SATA_FLAGS | PIIX_FLAG_SIDPR, | 
 | 		.pio_mask	= ATA_PIO4, | 
 | 		.mwdma_mask	= ATA_MWDMA2, | 
 | 		.udma_mask	= ATA_UDMA6, | 
 | 		.port_ops	= &piix_sata_ops, | 
 | 	}, | 
 |  | 
 | 	[ich8_2port_sata] = | 
 | 	{ | 
 | 		.flags		= PIIX_SATA_FLAGS | PIIX_FLAG_SIDPR, | 
 | 		.pio_mask	= ATA_PIO4, | 
 | 		.mwdma_mask	= ATA_MWDMA2, | 
 | 		.udma_mask	= ATA_UDMA6, | 
 | 		.port_ops	= &piix_sata_ops, | 
 | 	}, | 
 |  | 
 | 	[tolapai_sata] = | 
 | 	{ | 
 | 		.flags		= PIIX_SATA_FLAGS, | 
 | 		.pio_mask	= ATA_PIO4, | 
 | 		.mwdma_mask	= ATA_MWDMA2, | 
 | 		.udma_mask	= ATA_UDMA6, | 
 | 		.port_ops	= &piix_sata_ops, | 
 | 	}, | 
 |  | 
 | 	[ich8m_apple_sata] = | 
 | 	{ | 
 | 		.flags		= PIIX_SATA_FLAGS, | 
 | 		.pio_mask	= ATA_PIO4, | 
 | 		.mwdma_mask	= ATA_MWDMA2, | 
 | 		.udma_mask	= ATA_UDMA6, | 
 | 		.port_ops	= &piix_sata_ops, | 
 | 	}, | 
 |  | 
 | 	[piix_pata_vmw] = | 
 | 	{ | 
 | 		.flags		= PIIX_PATA_FLAGS, | 
 | 		.pio_mask	= ATA_PIO4, | 
 | 		.mwdma_mask	= ATA_MWDMA12_ONLY, /* mwdma1-2 ?? CHECK 0 should be ok but slow */ | 
 | 		.udma_mask	= ATA_UDMA2, | 
 | 		.port_ops	= &piix_vmw_ops, | 
 | 	}, | 
 |  | 
 | }; | 
 |  | 
 | 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); | 
 |  | 
 | 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 */ | 
 | 	{ 0x27DF, 0x1025, 0x0102 },	/* ICH7 on Acer 5602aWLMi */ | 
 | 	{ 0x27DF, 0x1025, 0x0110 },	/* ICH7 on Acer 3682WLMi */ | 
 | 	{ 0x27DF, 0x1028, 0x02b0 },	/* ICH7 on unknown Dell */ | 
 | 	{ 0x27DF, 0x1043, 0x1267 },	/* ICH7 on Asus W5F */ | 
 | 	{ 0x27DF, 0x103C, 0x30A1 },	/* ICH7 on HP Compaq nc2400 */ | 
 | 	{ 0x27DF, 0x103C, 0x361a },	/* ICH7 on unknown HP  */ | 
 | 	{ 0x27DF, 0x1071, 0xD221 },	/* ICH7 on Hercules EC-900 */ | 
 | 	{ 0x27DF, 0x152D, 0x0778 },	/* ICH7 on unknown Intel */ | 
 | 	{ 0x24CA, 0x1025, 0x0061 },	/* ICH4 on ACER Aspire 2023WLMi */ | 
 | 	{ 0x24CA, 0x1025, 0x003d },	/* ICH4 on ACER TM290 */ | 
 | 	{ 0x266F, 0x1025, 0x0066 },	/* ICH6 on ACER Aspire 1694WLMi */ | 
 | 	{ 0x2653, 0x1043, 0x82D8 },	/* ICH6M on Asus Eee 701 */ | 
 | 	{ 0x27df, 0x104d, 0x900e },	/* ICH7 on Sony TZ-90 */ | 
 | 	/* end marker */ | 
 | 	{ 0, } | 
 | }; | 
 |  | 
 | /** | 
 |  *	ich_pata_cable_detect - Probe host controller cable detect info | 
 |  *	@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). | 
 |  */ | 
 |  | 
 | static int ich_pata_cable_detect(struct ata_port *ap) | 
 | { | 
 | 	struct pci_dev *pdev = to_pci_dev(ap->host->dev); | 
 | 	struct piix_host_priv *hpriv = ap->host->private_data; | 
 | 	const struct ich_laptop *lap = &ich_laptop[0]; | 
 | 	u8 mask; | 
 |  | 
 | 	/* Check for specials - Acer Aspire 5602WLMi */ | 
 | 	while (lap->device) { | 
 | 		if (lap->device == pdev->device && | 
 | 		    lap->subvendor == pdev->subsystem_vendor && | 
 | 		    lap->subdevice == pdev->subsystem_device) | 
 | 			return ATA_CBL_PATA40_SHORT; | 
 |  | 
 | 		lap++; | 
 | 	} | 
 |  | 
 | 	/* check BIOS cable detect results */ | 
 | 	mask = ap->port_no == 0 ? PIIX_80C_PRI : PIIX_80C_SEC; | 
 | 	if ((hpriv->saved_iocfg & mask) == 0) | 
 | 		return ATA_CBL_PATA40; | 
 | 	return ATA_CBL_PATA80; | 
 | } | 
 |  | 
 | /** | 
 |  *	piix_pata_prereset - prereset for PATA host controller | 
 |  *	@link: Target link | 
 |  *	@deadline: deadline jiffies for the operation | 
 |  * | 
 |  *	LOCKING: | 
 |  *	None (inherited from caller). | 
 |  */ | 
 | static int piix_pata_prereset(struct ata_link *link, unsigned long deadline) | 
 | { | 
 | 	struct ata_port *ap = link->ap; | 
 | 	struct pci_dev *pdev = to_pci_dev(ap->host->dev); | 
 |  | 
 | 	if (!pci_test_config_bits(pdev, &piix_enable_bits[ap->port_no])) | 
 | 		return -ENOENT; | 
 | 	return ata_sff_prereset(link, deadline); | 
 | } | 
 |  | 
 | static DEFINE_SPINLOCK(piix_lock); | 
 |  | 
 | /** | 
 |  *	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) | 
 | { | 
 | 	struct pci_dev *dev	= to_pci_dev(ap->host->dev); | 
 | 	unsigned long flags; | 
 | 	unsigned int pio	= adev->pio_mode - XFER_PIO_0; | 
 | 	unsigned int is_slave	= (adev->devno != 0); | 
 | 	unsigned int master_port= ap->port_no ? 0x42 : 0x40; | 
 | 	unsigned int slave_port	= 0x44; | 
 | 	u16 master_data; | 
 | 	u8 slave_data; | 
 | 	u8 udma_enable; | 
 | 	int control = 0; | 
 |  | 
 | 	/* | 
 | 	 *	See Intel Document 298600-004 for the timing programing rules | 
 | 	 *	for ICH controllers. | 
 | 	 */ | 
 |  | 
 | 	static const	 /* ISP  RTC */ | 
 | 	u8 timings[][2]	= { { 0, 0 }, | 
 | 			    { 0, 0 }, | 
 | 			    { 1, 0 }, | 
 | 			    { 2, 1 }, | 
 | 			    { 2, 3 }, }; | 
 |  | 
 | 	if (pio >= 2) | 
 | 		control |= 1;	/* TIME1 enable */ | 
 | 	if (ata_pio_need_iordy(adev)) | 
 | 		control |= 2;	/* IE enable */ | 
 |  | 
 | 	/* Intel specifies that the PPE functionality is for disk only */ | 
 | 	if (adev->class == ATA_DEV_ATA) | 
 | 		control |= 4;	/* PPE enable */ | 
 |  | 
 | 	spin_lock_irqsave(&piix_lock, flags); | 
 |  | 
 | 	/* PIO configuration clears DTE unconditionally.  It will be | 
 | 	 * programmed in set_dmamode which is guaranteed to be called | 
 | 	 * after set_piomode if any DMA mode is available. | 
 | 	 */ | 
 | 	pci_read_config_word(dev, master_port, &master_data); | 
 | 	if (is_slave) { | 
 | 		/* clear TIME1|IE1|PPE1|DTE1 */ | 
 | 		master_data &= 0xff0f; | 
 | 		/* Enable SITRE (separate slave timing register) */ | 
 | 		master_data |= 0x4000; | 
 | 		/* enable PPE1, IE1 and TIME1 as needed */ | 
 | 		master_data |= (control << 4); | 
 | 		pci_read_config_byte(dev, slave_port, &slave_data); | 
 | 		slave_data &= (ap->port_no ? 0x0f : 0xf0); | 
 | 		/* Load the timing nibble for this slave */ | 
 | 		slave_data |= ((timings[pio][0] << 2) | timings[pio][1]) | 
 | 						<< (ap->port_no ? 4 : 0); | 
 | 	} else { | 
 | 		/* clear ISP|RCT|TIME0|IE0|PPE0|DTE0 */ | 
 | 		master_data &= 0xccf0; | 
 | 		/* Enable PPE, IE and TIME as appropriate */ | 
 | 		master_data |= control; | 
 | 		/* load ISP and RCT */ | 
 | 		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); | 
 |  | 
 | 	/* Ensure the UDMA bit is off - it will be turned back on if | 
 | 	   UDMA is selected */ | 
 |  | 
 | 	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); | 
 | 	} | 
 |  | 
 | 	spin_unlock_irqrestore(&piix_lock, flags); | 
 | } | 
 |  | 
 | /** | 
 |  *	do_pata_set_dmamode - Initialize host controller PATA PIO timings | 
 |  *	@ap: Port whose timings we are configuring | 
 |  *	@adev: Drive in question | 
 |  *	@isich: set if the chip is an ICH device | 
 |  * | 
 |  *	Set UDMA mode for device, in host controller PCI config space. | 
 |  * | 
 |  *	LOCKING: | 
 |  *	None (inherited from caller). | 
 |  */ | 
 |  | 
 | static void do_pata_set_dmamode(struct ata_port *ap, struct ata_device *adev, int isich) | 
 | { | 
 | 	struct pci_dev *dev	= to_pci_dev(ap->host->dev); | 
 | 	unsigned long flags; | 
 | 	u8 master_port		= ap->port_no ? 0x42 : 0x40; | 
 | 	u16 master_data; | 
 | 	u8 speed		= adev->dma_mode; | 
 | 	int devid		= adev->devno + 2 * ap->port_no; | 
 | 	u8 udma_enable		= 0; | 
 |  | 
 | 	static const	 /* ISP  RTC */ | 
 | 	u8 timings[][2]	= { { 0, 0 }, | 
 | 			    { 0, 0 }, | 
 | 			    { 1, 0 }, | 
 | 			    { 2, 1 }, | 
 | 			    { 2, 3 }, }; | 
 |  | 
 | 	spin_lock_irqsave(&piix_lock, flags); | 
 |  | 
 | 	pci_read_config_word(dev, master_port, &master_data); | 
 | 	if (ap->udma_mask) | 
 | 		pci_read_config_byte(dev, 0x48, &udma_enable); | 
 |  | 
 | 	if (speed >= XFER_UDMA_0) { | 
 | 		unsigned int udma = adev->dma_mode - XFER_UDMA_0; | 
 | 		u16 udma_timing; | 
 | 		u16 ideconf; | 
 | 		int u_clock, u_speed; | 
 |  | 
 | 		/* | 
 | 		 * UDMA is handled by a combination of clock switching and | 
 | 		 * selection of dividers | 
 | 		 * | 
 | 		 * Handy rule: Odd modes are UDMATIMx 01, even are 02 | 
 | 		 *	       except UDMA0 which is 00 | 
 | 		 */ | 
 | 		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 */ | 
 |  | 
 | 		udma_enable |= (1 << devid); | 
 |  | 
 | 		/* 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); | 
 |  | 
 | 		if (isich) { | 
 | 			/* 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); | 
 | 		} | 
 | 	} else { | 
 | 		/* | 
 | 		 * 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; | 
 |  | 
 | 		control = 3;	/* IORDY|TIME1 */ | 
 |  | 
 | 		/* If the drive MWDMA is faster than it can do PIO then | 
 | 		   we must force PIO into PIO0 */ | 
 |  | 
 | 		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 &= (ap->port_no ? 0x0f : 0xf0); | 
 | 			/* 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 */ | 
 | 			master_data &= 0xCCF4;	/* Mask out IORDY|TIME1|DMAONLY | 
 | 						   and master timing bits */ | 
 | 			master_data |= control; | 
 | 			master_data |= | 
 | 				(timings[pio][0] << 12) | | 
 | 				(timings[pio][1] << 8); | 
 | 		} | 
 |  | 
 | 		if (ap->udma_mask) | 
 | 			udma_enable &= ~(1 << devid); | 
 |  | 
 | 		pci_write_config_word(dev, master_port, master_data); | 
 | 	} | 
 | 	/* Don't scribble on 0x48 if the controller does not support UDMA */ | 
 | 	if (ap->udma_mask) | 
 | 		pci_write_config_byte(dev, 0x48, udma_enable); | 
 |  | 
 | 	spin_unlock_irqrestore(&piix_lock, flags); | 
 | } | 
 |  | 
 | /** | 
 |  *	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); | 
 | } | 
 |  | 
 | /* | 
 |  * Serial ATA Index/Data Pair Superset Registers access | 
 |  * | 
 |  * Beginning from ICH8, there's a sane way to access SCRs using index | 
 |  * and data register pair located at BAR5 which means that we have | 
 |  * separate SCRs for master and slave.  This is handled using libata | 
 |  * slave_link facility. | 
 |  */ | 
 | static const int piix_sidx_map[] = { | 
 | 	[SCR_STATUS]	= 0, | 
 | 	[SCR_ERROR]	= 2, | 
 | 	[SCR_CONTROL]	= 1, | 
 | }; | 
 |  | 
 | static void piix_sidpr_sel(struct ata_link *link, unsigned int reg) | 
 | { | 
 | 	struct ata_port *ap = link->ap; | 
 | 	struct piix_host_priv *hpriv = ap->host->private_data; | 
 |  | 
 | 	iowrite32(((ap->port_no * 2 + link->pmp) << 8) | piix_sidx_map[reg], | 
 | 		  hpriv->sidpr + PIIX_SIDPR_IDX); | 
 | } | 
 |  | 
 | static int piix_sidpr_scr_read(struct ata_link *link, | 
 | 			       unsigned int reg, u32 *val) | 
 | { | 
 | 	struct piix_host_priv *hpriv = link->ap->host->private_data; | 
 |  | 
 | 	if (reg >= ARRAY_SIZE(piix_sidx_map)) | 
 | 		return -EINVAL; | 
 |  | 
 | 	piix_sidpr_sel(link, reg); | 
 | 	*val = ioread32(hpriv->sidpr + PIIX_SIDPR_DATA); | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int piix_sidpr_scr_write(struct ata_link *link, | 
 | 				unsigned int reg, u32 val) | 
 | { | 
 | 	struct piix_host_priv *hpriv = link->ap->host->private_data; | 
 |  | 
 | 	if (reg >= ARRAY_SIZE(piix_sidx_map)) | 
 | 		return -EINVAL; | 
 |  | 
 | 	piix_sidpr_sel(link, reg); | 
 | 	iowrite32(val, hpriv->sidpr + PIIX_SIDPR_DATA); | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int piix_sidpr_set_lpm(struct ata_link *link, enum ata_lpm_policy policy, | 
 | 			      unsigned hints) | 
 | { | 
 | 	return sata_link_scr_lpm(link, policy, false); | 
 | } | 
 |  | 
 | static bool piix_irq_check(struct ata_port *ap) | 
 | { | 
 | 	if (unlikely(!ap->ioaddr.bmdma_addr)) | 
 | 		return false; | 
 |  | 
 | 	return ap->ops->bmdma_status(ap) & ATA_DMA_INTR; | 
 | } | 
 |  | 
 | #ifdef CONFIG_PM | 
 | static int piix_broken_suspend(void) | 
 | { | 
 | 	static const struct dmi_system_id sysids[] = { | 
 | 		{ | 
 | 			.ident = "TECRA M3", | 
 | 			.matches = { | 
 | 				DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"), | 
 | 				DMI_MATCH(DMI_PRODUCT_NAME, "TECRA M3"), | 
 | 			}, | 
 | 		}, | 
 | 		{ | 
 | 			.ident = "TECRA M3", | 
 | 			.matches = { | 
 | 				DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"), | 
 | 				DMI_MATCH(DMI_PRODUCT_NAME, "Tecra M3"), | 
 | 			}, | 
 | 		}, | 
 | 		{ | 
 | 			.ident = "TECRA M4", | 
 | 			.matches = { | 
 | 				DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"), | 
 | 				DMI_MATCH(DMI_PRODUCT_NAME, "Tecra M4"), | 
 | 			}, | 
 | 		}, | 
 | 		{ | 
 | 			.ident = "TECRA M4", | 
 | 			.matches = { | 
 | 				DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"), | 
 | 				DMI_MATCH(DMI_PRODUCT_NAME, "TECRA M4"), | 
 | 			}, | 
 | 		}, | 
 | 		{ | 
 | 			.ident = "TECRA M5", | 
 | 			.matches = { | 
 | 				DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"), | 
 | 				DMI_MATCH(DMI_PRODUCT_NAME, "TECRA M5"), | 
 | 			}, | 
 | 		}, | 
 | 		{ | 
 | 			.ident = "TECRA M6", | 
 | 			.matches = { | 
 | 				DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"), | 
 | 				DMI_MATCH(DMI_PRODUCT_NAME, "TECRA M6"), | 
 | 			}, | 
 | 		}, | 
 | 		{ | 
 | 			.ident = "TECRA M7", | 
 | 			.matches = { | 
 | 				DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"), | 
 | 				DMI_MATCH(DMI_PRODUCT_NAME, "TECRA M7"), | 
 | 			}, | 
 | 		}, | 
 | 		{ | 
 | 			.ident = "TECRA A8", | 
 | 			.matches = { | 
 | 				DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"), | 
 | 				DMI_MATCH(DMI_PRODUCT_NAME, "TECRA A8"), | 
 | 			}, | 
 | 		}, | 
 | 		{ | 
 | 			.ident = "Satellite R20", | 
 | 			.matches = { | 
 | 				DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"), | 
 | 				DMI_MATCH(DMI_PRODUCT_NAME, "Satellite R20"), | 
 | 			}, | 
 | 		}, | 
 | 		{ | 
 | 			.ident = "Satellite R25", | 
 | 			.matches = { | 
 | 				DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"), | 
 | 				DMI_MATCH(DMI_PRODUCT_NAME, "Satellite R25"), | 
 | 			}, | 
 | 		}, | 
 | 		{ | 
 | 			.ident = "Satellite U200", | 
 | 			.matches = { | 
 | 				DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"), | 
 | 				DMI_MATCH(DMI_PRODUCT_NAME, "Satellite U200"), | 
 | 			}, | 
 | 		}, | 
 | 		{ | 
 | 			.ident = "Satellite U200", | 
 | 			.matches = { | 
 | 				DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"), | 
 | 				DMI_MATCH(DMI_PRODUCT_NAME, "SATELLITE U200"), | 
 | 			}, | 
 | 		}, | 
 | 		{ | 
 | 			.ident = "Satellite Pro U200", | 
 | 			.matches = { | 
 | 				DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"), | 
 | 				DMI_MATCH(DMI_PRODUCT_NAME, "SATELLITE PRO U200"), | 
 | 			}, | 
 | 		}, | 
 | 		{ | 
 | 			.ident = "Satellite U205", | 
 | 			.matches = { | 
 | 				DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"), | 
 | 				DMI_MATCH(DMI_PRODUCT_NAME, "Satellite U205"), | 
 | 			}, | 
 | 		}, | 
 | 		{ | 
 | 			.ident = "SATELLITE U205", | 
 | 			.matches = { | 
 | 				DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"), | 
 | 				DMI_MATCH(DMI_PRODUCT_NAME, "SATELLITE U205"), | 
 | 			}, | 
 | 		}, | 
 | 		{ | 
 | 			.ident = "Portege M500", | 
 | 			.matches = { | 
 | 				DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"), | 
 | 				DMI_MATCH(DMI_PRODUCT_NAME, "PORTEGE M500"), | 
 | 			}, | 
 | 		}, | 
 | 		{ | 
 | 			.ident = "VGN-BX297XP", | 
 | 			.matches = { | 
 | 				DMI_MATCH(DMI_SYS_VENDOR, "Sony Corporation"), | 
 | 				DMI_MATCH(DMI_PRODUCT_NAME, "VGN-BX297XP"), | 
 | 			}, | 
 | 		}, | 
 |  | 
 | 		{ }	/* terminate list */ | 
 | 	}; | 
 | 	static const char *oemstrs[] = { | 
 | 		"Tecra M3,", | 
 | 	}; | 
 | 	int i; | 
 |  | 
 | 	if (dmi_check_system(sysids)) | 
 | 		return 1; | 
 |  | 
 | 	for (i = 0; i < ARRAY_SIZE(oemstrs); i++) | 
 | 		if (dmi_find_device(DMI_DEV_TYPE_OEM_STRING, oemstrs[i], NULL)) | 
 | 			return 1; | 
 |  | 
 | 	/* TECRA M4 sometimes forgets its identify and reports bogus | 
 | 	 * DMI information.  As the bogus information is a bit | 
 | 	 * generic, match as many entries as possible.  This manual | 
 | 	 * matching is necessary because dmi_system_id.matches is | 
 | 	 * limited to four entries. | 
 | 	 */ | 
 | 	if (dmi_match(DMI_SYS_VENDOR, "TOSHIBA") && | 
 | 	    dmi_match(DMI_PRODUCT_NAME, "000000") && | 
 | 	    dmi_match(DMI_PRODUCT_VERSION, "000000") && | 
 | 	    dmi_match(DMI_PRODUCT_SERIAL, "000000") && | 
 | 	    dmi_match(DMI_BOARD_VENDOR, "TOSHIBA") && | 
 | 	    dmi_match(DMI_BOARD_NAME, "Portable PC") && | 
 | 	    dmi_match(DMI_BOARD_VERSION, "Version A0")) | 
 | 		return 1; | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int piix_pci_device_suspend(struct pci_dev *pdev, pm_message_t mesg) | 
 | { | 
 | 	struct ata_host *host = dev_get_drvdata(&pdev->dev); | 
 | 	unsigned long flags; | 
 | 	int rc = 0; | 
 |  | 
 | 	rc = ata_host_suspend(host, mesg); | 
 | 	if (rc) | 
 | 		return rc; | 
 |  | 
 | 	/* Some braindamaged ACPI suspend implementations expect the | 
 | 	 * controller to be awake on entry; otherwise, it burns cpu | 
 | 	 * cycles and power trying to do something to the sleeping | 
 | 	 * beauty. | 
 | 	 */ | 
 | 	if (piix_broken_suspend() && (mesg.event & PM_EVENT_SLEEP)) { | 
 | 		pci_save_state(pdev); | 
 |  | 
 | 		/* mark its power state as "unknown", since we don't | 
 | 		 * know if e.g. the BIOS will change its device state | 
 | 		 * when we suspend. | 
 | 		 */ | 
 | 		if (pdev->current_state == PCI_D0) | 
 | 			pdev->current_state = PCI_UNKNOWN; | 
 |  | 
 | 		/* tell resume that it's waking up from broken suspend */ | 
 | 		spin_lock_irqsave(&host->lock, flags); | 
 | 		host->flags |= PIIX_HOST_BROKEN_SUSPEND; | 
 | 		spin_unlock_irqrestore(&host->lock, flags); | 
 | 	} else | 
 | 		ata_pci_device_do_suspend(pdev, mesg); | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int piix_pci_device_resume(struct pci_dev *pdev) | 
 | { | 
 | 	struct ata_host *host = dev_get_drvdata(&pdev->dev); | 
 | 	unsigned long flags; | 
 | 	int rc; | 
 |  | 
 | 	if (host->flags & PIIX_HOST_BROKEN_SUSPEND) { | 
 | 		spin_lock_irqsave(&host->lock, flags); | 
 | 		host->flags &= ~PIIX_HOST_BROKEN_SUSPEND; | 
 | 		spin_unlock_irqrestore(&host->lock, flags); | 
 |  | 
 | 		pci_set_power_state(pdev, PCI_D0); | 
 | 		pci_restore_state(pdev); | 
 |  | 
 | 		/* PCI device wasn't disabled during suspend.  Use | 
 | 		 * pci_reenable_device() to avoid affecting the enable | 
 | 		 * count. | 
 | 		 */ | 
 | 		rc = pci_reenable_device(pdev); | 
 | 		if (rc) | 
 | 			dev_err(&pdev->dev, | 
 | 				"failed to enable device after resume (%d)\n", | 
 | 				rc); | 
 | 	} else | 
 | 		rc = ata_pci_device_do_resume(pdev); | 
 |  | 
 | 	if (rc == 0) | 
 | 		ata_host_resume(host); | 
 |  | 
 | 	return rc; | 
 | } | 
 | #endif | 
 |  | 
 | static u8 piix_vmw_bmdma_status(struct ata_port *ap) | 
 | { | 
 | 	return ata_bmdma_status(ap) & ~ATA_DMA_ERR; | 
 | } | 
 |  | 
 | #define AHCI_PCI_BAR 5 | 
 | #define AHCI_GLOBAL_CTL 0x04 | 
 | #define AHCI_ENABLE (1 << 31) | 
 | static int piix_disable_ahci(struct pci_dev *pdev) | 
 | { | 
 | 	void __iomem *mmio; | 
 | 	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. | 
 | 	 */ | 
 |  | 
 | 	if (!pci_resource_start(pdev, AHCI_PCI_BAR) || | 
 | 	    !pci_resource_len(pdev, AHCI_PCI_BAR)) | 
 | 		return 0; | 
 |  | 
 | 	mmio = pci_iomap(pdev, AHCI_PCI_BAR, 64); | 
 | 	if (!mmio) | 
 | 		return -ENOMEM; | 
 |  | 
 | 	tmp = ioread32(mmio + AHCI_GLOBAL_CTL); | 
 | 	if (tmp & AHCI_ENABLE) { | 
 | 		tmp &= ~AHCI_ENABLE; | 
 | 		iowrite32(tmp, mmio + AHCI_GLOBAL_CTL); | 
 |  | 
 | 		tmp = ioread32(mmio + AHCI_GLOBAL_CTL); | 
 | 		if (tmp & AHCI_ENABLE) | 
 | 			rc = -EIO; | 
 | 	} | 
 |  | 
 | 	pci_iounmap(pdev, mmio); | 
 | 	return rc; | 
 | } | 
 |  | 
 | /** | 
 |  *	piix_check_450nx_errata	-	Check for problem 450NX setup | 
 |  *	@ata_dev: the PCI device to check | 
 |  * | 
 |  *	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; | 
 | 	int no_piix_dma = 0; | 
 |  | 
 | 	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_word(pdev, 0x41, &cfg); | 
 | 		/* Only on the original revision: IDE DMA can hang */ | 
 | 		if (pdev->revision == 0x00) | 
 | 			no_piix_dma = 1; | 
 | 		/* On all revisions below 5 PXB bus lock must be disabled for IDE */ | 
 | 		else if (cfg & (1<<14) && pdev->revision < 5) | 
 | 			no_piix_dma = 2; | 
 | 	} | 
 | 	if (no_piix_dma) | 
 | 		dev_warn(&ata_dev->dev, | 
 | 			 "450NX errata present, disabling IDE DMA%s\n", | 
 | 			 no_piix_dma == 2 ? " - a BIOS update may resolve this" | 
 | 			 : ""); | 
 |  | 
 | 	return no_piix_dma; | 
 | } | 
 |  | 
 | static void __devinit piix_init_pcs(struct ata_host *host, | 
 | 				    const struct piix_map_db *map_db) | 
 | { | 
 | 	struct pci_dev *pdev = to_pci_dev(host->dev); | 
 | 	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); | 
 | 	} | 
 | } | 
 |  | 
 | static const int *__devinit piix_init_sata_map(struct pci_dev *pdev, | 
 | 					       struct ata_port_info *pinfo, | 
 | 					       const struct piix_map_db *map_db) | 
 | { | 
 | 	const 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_info(&pdev->dev, "MAP ["); | 
 | 	for (i = 0; i < 4; i++) { | 
 | 		switch (map[i]) { | 
 | 		case RV: | 
 | 			invalid_map = 1; | 
 | 			pr_cont(" XX"); | 
 | 			break; | 
 |  | 
 | 		case NA: | 
 | 			pr_cont(" --"); | 
 | 			break; | 
 |  | 
 | 		case IDE: | 
 | 			WARN_ON((i & 1) || map[i + 1] != IDE); | 
 | 			pinfo[i / 2] = piix_port_info[ich_pata_100]; | 
 | 			i++; | 
 | 			pr_cont(" IDE IDE"); | 
 | 			break; | 
 |  | 
 | 		default: | 
 | 			pr_cont(" P%d", map[i]); | 
 | 			if (i & 1) | 
 | 				pinfo[i / 2].flags |= ATA_FLAG_SLAVE_POSS; | 
 | 			break; | 
 | 		} | 
 | 	} | 
 | 	pr_cont(" ]\n"); | 
 |  | 
 | 	if (invalid_map) | 
 | 		dev_err(&pdev->dev, "invalid MAP value %u\n", map_value); | 
 |  | 
 | 	return map; | 
 | } | 
 |  | 
 | static bool piix_no_sidpr(struct ata_host *host) | 
 | { | 
 | 	struct pci_dev *pdev = to_pci_dev(host->dev); | 
 |  | 
 | 	/* | 
 | 	 * Samsung DB-P70 only has three ATA ports exposed and | 
 | 	 * curiously the unconnected first port reports link online | 
 | 	 * while not responding to SRST protocol causing excessive | 
 | 	 * detection delay. | 
 | 	 * | 
 | 	 * Unfortunately, the system doesn't carry enough DMI | 
 | 	 * information to identify the machine but does have subsystem | 
 | 	 * vendor and device set.  As it's unclear whether the | 
 | 	 * subsystem vendor/device is used only for this specific | 
 | 	 * board, the port can't be disabled solely with the | 
 | 	 * information; however, turning off SIDPR access works around | 
 | 	 * the problem.  Turn it off. | 
 | 	 * | 
 | 	 * This problem is reported in bnc#441240. | 
 | 	 * | 
 | 	 * https://bugzilla.novell.com/show_bug.cgi?id=441420 | 
 | 	 */ | 
 | 	if (pdev->vendor == PCI_VENDOR_ID_INTEL && pdev->device == 0x2920 && | 
 | 	    pdev->subsystem_vendor == PCI_VENDOR_ID_SAMSUNG && | 
 | 	    pdev->subsystem_device == 0xb049) { | 
 | 		dev_warn(host->dev, | 
 | 			 "Samsung DB-P70 detected, disabling SIDPR\n"); | 
 | 		return true; | 
 | 	} | 
 |  | 
 | 	return false; | 
 | } | 
 |  | 
 | static int __devinit piix_init_sidpr(struct ata_host *host) | 
 | { | 
 | 	struct pci_dev *pdev = to_pci_dev(host->dev); | 
 | 	struct piix_host_priv *hpriv = host->private_data; | 
 | 	struct ata_link *link0 = &host->ports[0]->link; | 
 | 	u32 scontrol; | 
 | 	int i, rc; | 
 |  | 
 | 	/* check for availability */ | 
 | 	for (i = 0; i < 4; i++) | 
 | 		if (hpriv->map[i] == IDE) | 
 | 			return 0; | 
 |  | 
 | 	/* is it blacklisted? */ | 
 | 	if (piix_no_sidpr(host)) | 
 | 		return 0; | 
 |  | 
 | 	if (!(host->ports[0]->flags & PIIX_FLAG_SIDPR)) | 
 | 		return 0; | 
 |  | 
 | 	if (pci_resource_start(pdev, PIIX_SIDPR_BAR) == 0 || | 
 | 	    pci_resource_len(pdev, PIIX_SIDPR_BAR) != PIIX_SIDPR_LEN) | 
 | 		return 0; | 
 |  | 
 | 	if (pcim_iomap_regions(pdev, 1 << PIIX_SIDPR_BAR, DRV_NAME)) | 
 | 		return 0; | 
 |  | 
 | 	hpriv->sidpr = pcim_iomap_table(pdev)[PIIX_SIDPR_BAR]; | 
 |  | 
 | 	/* SCR access via SIDPR doesn't work on some configurations. | 
 | 	 * Give it a test drive by inhibiting power save modes which | 
 | 	 * we'll do anyway. | 
 | 	 */ | 
 | 	piix_sidpr_scr_read(link0, SCR_CONTROL, &scontrol); | 
 |  | 
 | 	/* if IPM is already 3, SCR access is probably working.  Don't | 
 | 	 * un-inhibit power save modes as BIOS might have inhibited | 
 | 	 * them for a reason. | 
 | 	 */ | 
 | 	if ((scontrol & 0xf00) != 0x300) { | 
 | 		scontrol |= 0x300; | 
 | 		piix_sidpr_scr_write(link0, SCR_CONTROL, scontrol); | 
 | 		piix_sidpr_scr_read(link0, SCR_CONTROL, &scontrol); | 
 |  | 
 | 		if ((scontrol & 0xf00) != 0x300) { | 
 | 			dev_info(host->dev, | 
 | 				 "SCR access via SIDPR is available but doesn't work\n"); | 
 | 			return 0; | 
 | 		} | 
 | 	} | 
 |  | 
 | 	/* okay, SCRs available, set ops and ask libata for slave_link */ | 
 | 	for (i = 0; i < 2; i++) { | 
 | 		struct ata_port *ap = host->ports[i]; | 
 |  | 
 | 		ap->ops = &piix_sidpr_sata_ops; | 
 |  | 
 | 		if (ap->flags & ATA_FLAG_SLAVE_POSS) { | 
 | 			rc = ata_slave_link_init(ap); | 
 | 			if (rc) | 
 | 				return rc; | 
 | 		} | 
 | 	} | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static void piix_iocfg_bit18_quirk(struct ata_host *host) | 
 | { | 
 | 	static const struct dmi_system_id sysids[] = { | 
 | 		{ | 
 | 			/* Clevo M570U sets IOCFG bit 18 if the cdrom | 
 | 			 * isn't used to boot the system which | 
 | 			 * disables the channel. | 
 | 			 */ | 
 | 			.ident = "M570U", | 
 | 			.matches = { | 
 | 				DMI_MATCH(DMI_SYS_VENDOR, "Clevo Co."), | 
 | 				DMI_MATCH(DMI_PRODUCT_NAME, "M570U"), | 
 | 			}, | 
 | 		}, | 
 |  | 
 | 		{ }	/* terminate list */ | 
 | 	}; | 
 | 	struct pci_dev *pdev = to_pci_dev(host->dev); | 
 | 	struct piix_host_priv *hpriv = host->private_data; | 
 |  | 
 | 	if (!dmi_check_system(sysids)) | 
 | 		return; | 
 |  | 
 | 	/* The datasheet says that bit 18 is NOOP but certain systems | 
 | 	 * seem to use it to disable a channel.  Clear the bit on the | 
 | 	 * affected systems. | 
 | 	 */ | 
 | 	if (hpriv->saved_iocfg & (1 << 18)) { | 
 | 		dev_info(&pdev->dev, "applying IOCFG bit18 quirk\n"); | 
 | 		pci_write_config_dword(pdev, PIIX_IOCFG, | 
 | 				       hpriv->saved_iocfg & ~(1 << 18)); | 
 | 	} | 
 | } | 
 |  | 
 | static bool piix_broken_system_poweroff(struct pci_dev *pdev) | 
 | { | 
 | 	static const struct dmi_system_id broken_systems[] = { | 
 | 		{ | 
 | 			.ident = "HP Compaq 2510p", | 
 | 			.matches = { | 
 | 				DMI_MATCH(DMI_SYS_VENDOR, "Hewlett-Packard"), | 
 | 				DMI_MATCH(DMI_PRODUCT_NAME, "HP Compaq 2510p"), | 
 | 			}, | 
 | 			/* PCI slot number of the controller */ | 
 | 			.driver_data = (void *)0x1FUL, | 
 | 		}, | 
 | 		{ | 
 | 			.ident = "HP Compaq nc6000", | 
 | 			.matches = { | 
 | 				DMI_MATCH(DMI_SYS_VENDOR, "Hewlett-Packard"), | 
 | 				DMI_MATCH(DMI_PRODUCT_NAME, "HP Compaq nc6000"), | 
 | 			}, | 
 | 			/* PCI slot number of the controller */ | 
 | 			.driver_data = (void *)0x1FUL, | 
 | 		}, | 
 |  | 
 | 		{ }	/* terminate list */ | 
 | 	}; | 
 | 	const struct dmi_system_id *dmi = dmi_first_match(broken_systems); | 
 |  | 
 | 	if (dmi) { | 
 | 		unsigned long slot = (unsigned long)dmi->driver_data; | 
 | 		/* apply the quirk only to on-board controllers */ | 
 | 		return slot == PCI_SLOT(pdev->devfn); | 
 | 	} | 
 |  | 
 | 	return false; | 
 | } | 
 |  | 
 | /** | 
 |  *	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 __devinit piix_init_one(struct pci_dev *pdev, | 
 | 				   const struct pci_device_id *ent) | 
 | { | 
 | 	struct device *dev = &pdev->dev; | 
 | 	struct ata_port_info port_info[2]; | 
 | 	const struct ata_port_info *ppi[] = { &port_info[0], &port_info[1] }; | 
 | 	struct scsi_host_template *sht = &piix_sht; | 
 | 	unsigned long port_flags; | 
 | 	struct ata_host *host; | 
 | 	struct piix_host_priv *hpriv; | 
 | 	int rc; | 
 |  | 
 | 	ata_print_version_once(&pdev->dev, DRV_VERSION); | 
 |  | 
 | 	/* no hotplugging support for later devices (FIXME) */ | 
 | 	if (!in_module_init && ent->driver_data >= ich5_sata) | 
 | 		return -ENODEV; | 
 |  | 
 | 	if (piix_broken_system_poweroff(pdev)) { | 
 | 		piix_port_info[ent->driver_data].flags |= | 
 | 				ATA_FLAG_NO_POWEROFF_SPINDOWN | | 
 | 					ATA_FLAG_NO_HIBERNATE_SPINDOWN; | 
 | 		dev_info(&pdev->dev, "quirky BIOS, skipping spindown " | 
 | 				"on poweroff and hibernation\n"); | 
 | 	} | 
 |  | 
 | 	port_info[0] = piix_port_info[ent->driver_data]; | 
 | 	port_info[1] = piix_port_info[ent->driver_data]; | 
 |  | 
 | 	port_flags = port_info[0].flags; | 
 |  | 
 | 	/* enable device and prepare host */ | 
 | 	rc = pcim_enable_device(pdev); | 
 | 	if (rc) | 
 | 		return rc; | 
 |  | 
 | 	hpriv = devm_kzalloc(dev, sizeof(*hpriv), GFP_KERNEL); | 
 | 	if (!hpriv) | 
 | 		return -ENOMEM; | 
 |  | 
 | 	/* Save IOCFG, this will be used for cable detection, quirk | 
 | 	 * detection and restoration on detach.  This is necessary | 
 | 	 * because some ACPI implementations mess up cable related | 
 | 	 * bits on _STM.  Reported on kernel bz#11879. | 
 | 	 */ | 
 | 	pci_read_config_dword(pdev, PIIX_IOCFG, &hpriv->saved_iocfg); | 
 |  | 
 | 	/* ICH6R may be driven by either ata_piix or ahci driver | 
 | 	 * regardless of BIOS configuration.  Make sure AHCI mode is | 
 | 	 * off. | 
 | 	 */ | 
 | 	if (pdev->vendor == PCI_VENDOR_ID_INTEL && pdev->device == 0x2652) { | 
 | 		rc = piix_disable_ahci(pdev); | 
 | 		if (rc) | 
 | 			return rc; | 
 | 	} | 
 |  | 
 | 	/* SATA map init can change port_info, do it before prepping host */ | 
 | 	if (port_flags & ATA_FLAG_SATA) | 
 | 		hpriv->map = piix_init_sata_map(pdev, port_info, | 
 | 					piix_map_db_table[ent->driver_data]); | 
 |  | 
 | 	rc = ata_pci_bmdma_prepare_host(pdev, ppi, &host); | 
 | 	if (rc) | 
 | 		return rc; | 
 | 	host->private_data = hpriv; | 
 |  | 
 | 	/* initialize controller */ | 
 | 	if (port_flags & ATA_FLAG_SATA) { | 
 | 		piix_init_pcs(host, piix_map_db_table[ent->driver_data]); | 
 | 		rc = piix_init_sidpr(host); | 
 | 		if (rc) | 
 | 			return rc; | 
 | 		if (host->ports[0]->ops == &piix_sidpr_sata_ops) | 
 | 			sht = &piix_sidpr_sht; | 
 | 	} | 
 |  | 
 | 	/* apply IOCFG bit18 quirk */ | 
 | 	piix_iocfg_bit18_quirk(host); | 
 |  | 
 | 	/* 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). | 
 | 	 */ | 
 | 	if (port_flags & PIIX_FLAG_CHECKINTR) | 
 | 		pci_intx(pdev, 1); | 
 |  | 
 | 	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 */ | 
 | 		host->ports[0]->mwdma_mask = 0; | 
 | 		host->ports[0]->udma_mask = 0; | 
 | 		host->ports[1]->mwdma_mask = 0; | 
 | 		host->ports[1]->udma_mask = 0; | 
 | 	} | 
 | 	host->flags |= ATA_HOST_PARALLEL_SCAN; | 
 |  | 
 | 	pci_set_master(pdev); | 
 | 	return ata_pci_sff_activate_host(host, ata_bmdma_interrupt, sht); | 
 | } | 
 |  | 
 | static void piix_remove_one(struct pci_dev *pdev) | 
 | { | 
 | 	struct ata_host *host = dev_get_drvdata(&pdev->dev); | 
 | 	struct piix_host_priv *hpriv = host->private_data; | 
 |  | 
 | 	pci_write_config_dword(pdev, PIIX_IOCFG, hpriv->saved_iocfg); | 
 |  | 
 | 	ata_pci_remove_one(pdev); | 
 | } | 
 |  | 
 | static int __init piix_init(void) | 
 | { | 
 | 	int rc; | 
 |  | 
 | 	DPRINTK("pci_register_driver\n"); | 
 | 	rc = pci_register_driver(&piix_pci_driver); | 
 | 	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); |