1805 lines
		
	
	
		
			50 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			1805 lines
		
	
	
		
			50 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  *    ata_piix.c - Intel PATA/SATA controllers
 | |
|  *
 | |
|  *    Maintained by:  Tejun Heo <tj@kernel.org>
 | |
|  *    		    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/driver-api/libata.rst
 | |
|  *
 | |
|  *  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, /* address map 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_FLAG_PIO16		= (1 << 30), /*support 16bit PIO only*/
 | |
| 
 | |
| 	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 */
 | |
| 	ich8_sata_snb,
 | |
| 	ich8_2port_sata_snb,
 | |
| 	ich8_2port_sata_byt,
 | |
| };
 | |
| 
 | |
| 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 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 },
 | |
| 	/* 82801GBM/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_snb },
 | |
| 	/* SATA Controller IDE (CPT) */
 | |
| 	{ 0x8086, 0x1c01, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata_snb },
 | |
| 	/* 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_snb },
 | |
| 	/* 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_snb },
 | |
| 	/* SATA Controller IDE (Panther Point) */
 | |
| 	{ 0x8086, 0x1e01, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata_snb },
 | |
| 	/* 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 },
 | |
| 	/* SATA Controller IDE (Lynx Point) */
 | |
| 	{ 0x8086, 0x8c00, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata_snb },
 | |
| 	/* SATA Controller IDE (Lynx Point) */
 | |
| 	{ 0x8086, 0x8c01, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata_snb },
 | |
| 	/* SATA Controller IDE (Lynx Point) */
 | |
| 	{ 0x8086, 0x8c08, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata_snb },
 | |
| 	/* SATA Controller IDE (Lynx Point) */
 | |
| 	{ 0x8086, 0x8c09, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata },
 | |
| 	/* SATA Controller IDE (Lynx Point-LP) */
 | |
| 	{ 0x8086, 0x9c00, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata_snb },
 | |
| 	/* SATA Controller IDE (Lynx Point-LP) */
 | |
| 	{ 0x8086, 0x9c01, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata_snb },
 | |
| 	/* SATA Controller IDE (Lynx Point-LP) */
 | |
| 	{ 0x8086, 0x9c08, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata },
 | |
| 	/* SATA Controller IDE (Lynx Point-LP) */
 | |
| 	{ 0x8086, 0x9c09, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata },
 | |
| 	/* SATA Controller IDE (DH89xxCC) */
 | |
| 	{ 0x8086, 0x2326, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata },
 | |
| 	/* SATA Controller IDE (Avoton) */
 | |
| 	{ 0x8086, 0x1f20, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata_snb },
 | |
| 	/* SATA Controller IDE (Avoton) */
 | |
| 	{ 0x8086, 0x1f21, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata_snb },
 | |
| 	/* SATA Controller IDE (Avoton) */
 | |
| 	{ 0x8086, 0x1f30, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata },
 | |
| 	/* SATA Controller IDE (Avoton) */
 | |
| 	{ 0x8086, 0x1f31, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata },
 | |
| 	/* SATA Controller IDE (Wellsburg) */
 | |
| 	{ 0x8086, 0x8d00, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata_snb },
 | |
| 	/* SATA Controller IDE (Wellsburg) */
 | |
| 	{ 0x8086, 0x8d08, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata_snb },
 | |
| 	/* SATA Controller IDE (Wellsburg) */
 | |
| 	{ 0x8086, 0x8d60, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata_snb },
 | |
| 	/* SATA Controller IDE (Wellsburg) */
 | |
| 	{ 0x8086, 0x8d68, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata },
 | |
| 	/* SATA Controller IDE (BayTrail) */
 | |
| 	{ 0x8086, 0x0F20, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata_byt },
 | |
| 	{ 0x8086, 0x0F21, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata_byt },
 | |
| 	/* SATA Controller IDE (Coleto Creek) */
 | |
| 	{ 0x8086, 0x23a6, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata },
 | |
| 	/* SATA Controller IDE (9 Series) */
 | |
| 	{ 0x8086, 0x8c88, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata_snb },
 | |
| 	/* SATA Controller IDE (9 Series) */
 | |
| 	{ 0x8086, 0x8c89, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_2port_sata_snb },
 | |
| 	/* SATA Controller IDE (9 Series) */
 | |
| 	{ 0x8086, 0x8c80, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata_snb },
 | |
| 	/* SATA Controller IDE (9 Series) */
 | |
| 	{ 0x8086, 0x8c81, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich8_sata_snb },
 | |
| 
 | |
| 	{ }	/* terminate list */
 | |
| };
 | |
| 
 | |
| 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,
 | |
| 	[ich8_sata_snb]		= &ich8_map_db,
 | |
| 	[ich8_2port_sata_snb]	= &ich8_2port_map_db,
 | |
| 	[ich8_2port_sata_byt]	= &ich8_2port_map_db,
 | |
| };
 | |
| 
 | |
| static const 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 */
 | |
| 	{ 0x24CA, 0x10CF, 0x11AB },	/* ICH4M on Fujitsu-Siemens Lifebook S6120 */
 | |
| 	{ 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, }
 | |
| };
 | |
| 
 | |
| static int piix_port_start(struct ata_port *ap)
 | |
| {
 | |
| 	if (!(ap->flags & PIIX_FLAG_PIO16))
 | |
| 		ap->pflags |= ATA_PFLAG_PIO32 | ATA_PFLAG_PIO32CHANGE;
 | |
| 
 | |
| 	return ata_bmdma_port_start(ap);
 | |
| }
 | |
| 
 | |
| /**
 | |
|  *	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 */
 | |
| 	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);
 | |
| 
 | |
| static void piix_set_timings(struct ata_port *ap, struct ata_device *adev,
 | |
| 			     u8 pio)
 | |
| {
 | |
| 	struct pci_dev *dev	= to_pci_dev(ap->host->dev);
 | |
| 	unsigned long flags;
 | |
| 	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 */
 | |
| 	/*
 | |
| 	 * If the drive MWDMA is faster than it can do PIO then
 | |
| 	 * we must force PIO into PIO0
 | |
| 	 */
 | |
| 	if (adev->pio_mode < XFER_PIO_0 + pio)
 | |
| 		/* Enable DMA timing only */
 | |
| 		control |= 8;	/* PIO cycles in PIO0 */
 | |
| 
 | |
| 	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 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);
 | |
| 	}
 | |
| 
 | |
| 	/* Enable SITRE (separate slave timing register) */
 | |
| 	master_data |= 0x4000;
 | |
| 	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);
 | |
| }
 | |
| 
 | |
| /**
 | |
|  *	piix_set_piomode - Initialize host controller PATA PIO timings
 | |
|  *	@ap: Port whose timings we are configuring
 | |
|  *	@adev: Drive in question
 | |
|  *
 | |
|  *	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)
 | |
| {
 | |
| 	piix_set_timings(ap, adev, adev->pio_mode - XFER_PIO_0);
 | |
| }
 | |
| 
 | |
| /**
 | |
|  *	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 speed		= adev->dma_mode;
 | |
| 	int devid		= adev->devno + 2 * ap->port_no;
 | |
| 	u8 udma_enable		= 0;
 | |
| 
 | |
| 	if (speed >= XFER_UDMA_0) {
 | |
| 		unsigned int udma = speed - XFER_UDMA_0;
 | |
| 		u16 udma_timing;
 | |
| 		u16 ideconf;
 | |
| 		int u_clock, u_speed;
 | |
| 
 | |
| 		spin_lock_irqsave(&piix_lock, flags);
 | |
| 
 | |
| 		pci_read_config_byte(dev, 0x48, &udma_enable);
 | |
| 
 | |
| 		/*
 | |
| 		 * 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);
 | |
| 		}
 | |
| 
 | |
| 		pci_write_config_byte(dev, 0x48, udma_enable);
 | |
| 
 | |
| 		spin_unlock_irqrestore(&piix_lock, flags);
 | |
| 	} else {
 | |
| 		/* MWDMA is driven by the PIO timings. */
 | |
| 		unsigned int mwdma = speed - XFER_MW_DMA_0;
 | |
| 		const unsigned int needed_pio[3] = {
 | |
| 			XFER_PIO_0, XFER_PIO_3, XFER_PIO_4
 | |
| 		};
 | |
| 		int pio = needed_pio[mwdma] - XFER_PIO_0;
 | |
| 
 | |
| 		/* XFER_PIO_0 is never used currently */
 | |
| 		piix_set_timings(ap, adev, pio);
 | |
| 	}
 | |
| }
 | |
| 
 | |
| /**
 | |
|  *	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_SLEEP
 | |
| 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 M3",
 | |
| 			.matches = {
 | |
| 				DMI_MATCH(DMI_OEM_STRING, "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 = "Satellite Pro A120",
 | |
| 			.matches = {
 | |
| 				DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
 | |
| 				DMI_MATCH(DMI_PRODUCT_NAME, "Satellite Pro A120"),
 | |
| 			},
 | |
| 		},
 | |
| 		{
 | |
| 			.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 */
 | |
| 	};
 | |
| 
 | |
| 	if (dmi_check_system(sysids))
 | |
| 		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 = pci_get_drvdata(pdev);
 | |
| 	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 = pci_get_drvdata(pdev);
 | |
| 	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;
 | |
| }
 | |
| 
 | |
| 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,
 | |
| 	.port_start		= piix_port_start,
 | |
| };
 | |
| 
 | |
| 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 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,
 | |
| 	},
 | |
| 
 | |
| 	/*
 | |
| 	 * some Sandybridge chipsets have broken 32 mode up to now,
 | |
| 	 * see https://bugzilla.kernel.org/show_bug.cgi?id=40592
 | |
| 	 */
 | |
| 	[ich8_sata_snb] =
 | |
| 	{
 | |
| 		.flags		= PIIX_SATA_FLAGS | PIIX_FLAG_SIDPR | PIIX_FLAG_PIO16,
 | |
| 		.pio_mask	= ATA_PIO4,
 | |
| 		.mwdma_mask	= ATA_MWDMA2,
 | |
| 		.udma_mask	= ATA_UDMA6,
 | |
| 		.port_ops	= &piix_sata_ops,
 | |
| 	},
 | |
| 
 | |
| 	[ich8_2port_sata_snb] =
 | |
| 	{
 | |
| 		.flags		= PIIX_SATA_FLAGS | PIIX_FLAG_SIDPR
 | |
| 					| PIIX_FLAG_PIO16,
 | |
| 		.pio_mask	= ATA_PIO4,
 | |
| 		.mwdma_mask	= ATA_MWDMA2,
 | |
| 		.udma_mask	= ATA_UDMA6,
 | |
| 		.port_ops	= &piix_sata_ops,
 | |
| 	},
 | |
| 
 | |
| 	[ich8_2port_sata_byt] =
 | |
| 	{
 | |
| 		.flags          = PIIX_SATA_FLAGS | PIIX_FLAG_SIDPR | PIIX_FLAG_PIO16,
 | |
| 		.pio_mask       = ATA_PIO4,
 | |
| 		.mwdma_mask     = ATA_MWDMA2,
 | |
| 		.udma_mask      = ATA_UDMA6,
 | |
| 		.port_ops       = &piix_sata_ops,
 | |
| 	},
 | |
| 
 | |
| };
 | |
| 
 | |
| #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 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 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 *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;
 | |
| 	char buf[32];
 | |
| 	char *p = buf, *end = buf + sizeof(buf);
 | |
| 
 | |
| 	pci_read_config_byte(pdev, ICH5_PMR, &map_value);
 | |
| 
 | |
| 	map = map_db->map[map_value & map_db->mask];
 | |
| 
 | |
| 	for (i = 0; i < 4; i++) {
 | |
| 		switch (map[i]) {
 | |
| 		case RV:
 | |
| 			invalid_map = 1;
 | |
| 			p += scnprintf(p, end - p, " XX");
 | |
| 			break;
 | |
| 
 | |
| 		case NA:
 | |
| 			p += scnprintf(p, end - p, " --");
 | |
| 			break;
 | |
| 
 | |
| 		case IDE:
 | |
| 			WARN_ON((i & 1) || map[i + 1] != IDE);
 | |
| 			pinfo[i / 2] = piix_port_info[ich_pata_100];
 | |
| 			i++;
 | |
| 			p += scnprintf(p, end - p, " IDE IDE");
 | |
| 			break;
 | |
| 
 | |
| 		default:
 | |
| 			p += scnprintf(p, end - p, " P%d", map[i]);
 | |
| 			if (i & 1)
 | |
| 				pinfo[i / 2].flags |= ATA_FLAG_SLAVE_POSS;
 | |
| 			break;
 | |
| 		}
 | |
| 	}
 | |
| 	dev_info(&pdev->dev, "MAP [%s ]\n", buf);
 | |
| 
 | |
| 	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 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;
 | |
| }
 | |
| 
 | |
| static int prefer_ms_hyperv = 1;
 | |
| module_param(prefer_ms_hyperv, int, 0);
 | |
| MODULE_PARM_DESC(prefer_ms_hyperv,
 | |
| 	"Prefer Hyper-V paravirtualization drivers instead of ATA, "
 | |
| 	"0 - Use ATA drivers, "
 | |
| 	"1 (Default) - Use the paravirtualization drivers.");
 | |
| 
 | |
| static void piix_ignore_devices_quirk(struct ata_host *host)
 | |
| {
 | |
| #if IS_ENABLED(CONFIG_HYPERV_STORAGE)
 | |
| 	static const struct dmi_system_id ignore_hyperv[] = {
 | |
| 		{
 | |
| 			/* On Hyper-V hypervisors the disks are exposed on
 | |
| 			 * both the emulated SATA controller and on the
 | |
| 			 * paravirtualised drivers.  The CD/DVD devices
 | |
| 			 * are only exposed on the emulated controller.
 | |
| 			 * Request we ignore ATA devices on this host.
 | |
| 			 */
 | |
| 			.ident = "Hyper-V Virtual Machine",
 | |
| 			.matches = {
 | |
| 				DMI_MATCH(DMI_SYS_VENDOR,
 | |
| 						"Microsoft Corporation"),
 | |
| 				DMI_MATCH(DMI_PRODUCT_NAME, "Virtual Machine"),
 | |
| 			},
 | |
| 		},
 | |
| 		{ }	/* terminate list */
 | |
| 	};
 | |
| 	static const struct dmi_system_id allow_virtual_pc[] = {
 | |
| 		{
 | |
| 			/* In MS Virtual PC guests the DMI ident is nearly
 | |
| 			 * identical to a Hyper-V guest. One difference is the
 | |
| 			 * product version which is used here to identify
 | |
| 			 * a Virtual PC guest. This entry allows ata_piix to
 | |
| 			 * drive the emulated hardware.
 | |
| 			 */
 | |
| 			.ident = "MS Virtual PC 2007",
 | |
| 			.matches = {
 | |
| 				DMI_MATCH(DMI_SYS_VENDOR,
 | |
| 						"Microsoft Corporation"),
 | |
| 				DMI_MATCH(DMI_PRODUCT_NAME, "Virtual Machine"),
 | |
| 				DMI_MATCH(DMI_PRODUCT_VERSION, "VS2005R2"),
 | |
| 			},
 | |
| 		},
 | |
| 		{ }	/* terminate list */
 | |
| 	};
 | |
| 	const struct dmi_system_id *ignore = dmi_first_match(ignore_hyperv);
 | |
| 	const struct dmi_system_id *allow = dmi_first_match(allow_virtual_pc);
 | |
| 
 | |
| 	if (ignore && !allow && prefer_ms_hyperv) {
 | |
| 		host->flags |= ATA_HOST_IGNORE_ATA;
 | |
| 		dev_info(host->dev, "%s detected, ATA device ignore set\n",
 | |
| 			ignore->ident);
 | |
| 	}
 | |
| #endif
 | |
| }
 | |
| 
 | |
| /**
 | |
|  *	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)
 | |
| {
 | |
| 	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;
 | |
| 
 | |
| 	/* Allow hosts to specify device types to ignore when scanning. */
 | |
| 	piix_ignore_devices_quirk(host);
 | |
| 
 | |
| 	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 = pci_get_drvdata(pdev);
 | |
| 	struct piix_host_priv *hpriv = host->private_data;
 | |
| 
 | |
| 	pci_write_config_dword(pdev, PIIX_IOCFG, hpriv->saved_iocfg);
 | |
| 
 | |
| 	ata_pci_remove_one(pdev);
 | |
| }
 | |
| 
 | |
| 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_SLEEP
 | |
| 	.suspend		= piix_pci_device_suspend,
 | |
| 	.resume			= piix_pci_device_resume,
 | |
| #endif
 | |
| };
 | |
| 
 | |
| 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);
 |