Orange Pi5 kernel

Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards

3 Commits   0 Branches   0 Tags
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)  *	i2c-ali1563.c - i2c driver for the ALi 1563 Southbridge
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  *	Copyright (C) 2004 Patrick Mochel
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6)  *		      2005 Rudolf Marek <r.marek@assembler.cz>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8)  *	The 1563 southbridge is deceptively similar to the 1533, with a
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9)  *	few notable exceptions. One of those happens to be the fact they
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10)  *	upgraded the i2c core to be 2.0 compliant, and happens to be almost
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11)  *	identical to the i2c controller found in the Intel 801 south
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12)  *	bridges.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14)  *	This driver is based on a mix of the 15x3, 1535, and i801 drivers,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15)  *	with a little help from the ALi 1563 spec.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) #include <linux/delay.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) #include <linux/i2c.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) #include <linux/pci.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) #include <linux/acpi.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) #define ALI1563_MAX_TIMEOUT	500
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) #define	ALI1563_SMBBA		0x80
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) #define ALI1563_SMB_IOEN	1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) #define ALI1563_SMB_HOSTEN	2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) #define ALI1563_SMB_IOSIZE	16
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) #define SMB_HST_STS	(ali1563_smba + 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) #define SMB_HST_CNTL1	(ali1563_smba + 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) #define SMB_HST_CNTL2	(ali1563_smba + 2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) #define SMB_HST_CMD	(ali1563_smba + 3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) #define SMB_HST_ADD	(ali1563_smba + 4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) #define SMB_HST_DAT0	(ali1563_smba + 5)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) #define SMB_HST_DAT1	(ali1563_smba + 6)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) #define SMB_BLK_DAT	(ali1563_smba + 7)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) #define HST_STS_BUSY	0x01
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) #define HST_STS_INTR	0x02
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) #define HST_STS_DEVERR	0x04
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) #define HST_STS_BUSERR	0x08
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) #define HST_STS_FAIL	0x10
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) #define HST_STS_DONE	0x80
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) #define HST_STS_BAD	0x1c
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) #define HST_CNTL1_TIMEOUT	0x80
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) #define HST_CNTL1_LAST		0x40
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) #define HST_CNTL2_KILL		0x04
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) #define HST_CNTL2_START		0x40
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) #define HST_CNTL2_QUICK		0x00
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) #define HST_CNTL2_BYTE		0x01
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) #define HST_CNTL2_BYTE_DATA	0x02
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) #define HST_CNTL2_WORD_DATA	0x03
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) #define HST_CNTL2_BLOCK		0x05
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) #define HST_CNTL2_SIZEMASK	0x38
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) static struct pci_driver ali1563_pci_driver;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) static unsigned short ali1563_smba;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) static int ali1563_transaction(struct i2c_adapter *a, int size)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 	u32 data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 	int timeout;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) 	int status = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) 	dev_dbg(&a->dev, "Transaction (pre): STS=%02x, CNTL1=%02x, "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 		"CNTL2=%02x, CMD=%02x, ADD=%02x, DAT0=%02x, DAT1=%02x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 		inb_p(SMB_HST_STS), inb_p(SMB_HST_CNTL1), inb_p(SMB_HST_CNTL2),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) 		inb_p(SMB_HST_CMD), inb_p(SMB_HST_ADD), inb_p(SMB_HST_DAT0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) 		inb_p(SMB_HST_DAT1));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 	data = inb_p(SMB_HST_STS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) 	if (data & HST_STS_BAD) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) 		dev_err(&a->dev, "ali1563: Trying to reset busy device\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) 		outb_p(data | HST_STS_BAD, SMB_HST_STS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 		data = inb_p(SMB_HST_STS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) 		if (data & HST_STS_BAD)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) 			return -EBUSY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 	outb_p(inb_p(SMB_HST_CNTL2) | HST_CNTL2_START, SMB_HST_CNTL2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 	timeout = ALI1563_MAX_TIMEOUT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 	do {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) 		msleep(1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 	} while (((data = inb_p(SMB_HST_STS)) & HST_STS_BUSY) && --timeout);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 	dev_dbg(&a->dev, "Transaction (post): STS=%02x, CNTL1=%02x, "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 		"CNTL2=%02x, CMD=%02x, ADD=%02x, DAT0=%02x, DAT1=%02x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) 		inb_p(SMB_HST_STS), inb_p(SMB_HST_CNTL1), inb_p(SMB_HST_CNTL2),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 		inb_p(SMB_HST_CMD), inb_p(SMB_HST_ADD), inb_p(SMB_HST_DAT0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 		inb_p(SMB_HST_DAT1));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 	if (timeout && !(data & HST_STS_BAD))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) 	if (!timeout) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) 		dev_err(&a->dev, "Timeout - Trying to KILL transaction!\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 		/* Issue 'kill' to host controller */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 		outb_p(HST_CNTL2_KILL, SMB_HST_CNTL2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 		data = inb_p(SMB_HST_STS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) 		status = -ETIMEDOUT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 	/* device error - no response, ignore the autodetection case */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 	if (data & HST_STS_DEVERR) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 		if (size != HST_CNTL2_QUICK)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 			dev_err(&a->dev, "Device error!\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 		status = -ENXIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 	/* bus collision */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) 	if (data & HST_STS_BUSERR) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) 		dev_err(&a->dev, "Bus collision!\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) 		/* Issue timeout, hoping it helps */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) 		outb_p(HST_CNTL1_TIMEOUT, SMB_HST_CNTL1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) 	if (data & HST_STS_FAIL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) 		dev_err(&a->dev, "Cleaning fail after KILL!\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 		outb_p(0x0, SMB_HST_CNTL2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 	return status;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) static int ali1563_block_start(struct i2c_adapter *a)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 	u32 data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 	int timeout;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 	int status = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) 	dev_dbg(&a->dev, "Block (pre): STS=%02x, CNTL1=%02x, "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) 		"CNTL2=%02x, CMD=%02x, ADD=%02x, DAT0=%02x, DAT1=%02x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) 		inb_p(SMB_HST_STS), inb_p(SMB_HST_CNTL1), inb_p(SMB_HST_CNTL2),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) 		inb_p(SMB_HST_CMD), inb_p(SMB_HST_ADD), inb_p(SMB_HST_DAT0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) 		inb_p(SMB_HST_DAT1));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) 	data = inb_p(SMB_HST_STS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) 	if (data & HST_STS_BAD) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) 		dev_warn(&a->dev, "ali1563: Trying to reset busy device\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) 		outb_p(data | HST_STS_BAD, SMB_HST_STS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) 		data = inb_p(SMB_HST_STS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) 		if (data & HST_STS_BAD)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) 			return -EBUSY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 	/* Clear byte-ready bit */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) 	outb_p(data | HST_STS_DONE, SMB_HST_STS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 	/* Start transaction and wait for byte-ready bit to be set */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) 	outb_p(inb_p(SMB_HST_CNTL2) | HST_CNTL2_START, SMB_HST_CNTL2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) 	timeout = ALI1563_MAX_TIMEOUT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) 	do {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) 		msleep(1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 	} while (!((data = inb_p(SMB_HST_STS)) & HST_STS_DONE) && --timeout);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) 	dev_dbg(&a->dev, "Block (post): STS=%02x, CNTL1=%02x, "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) 		"CNTL2=%02x, CMD=%02x, ADD=%02x, DAT0=%02x, DAT1=%02x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) 		inb_p(SMB_HST_STS), inb_p(SMB_HST_CNTL1), inb_p(SMB_HST_CNTL2),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) 		inb_p(SMB_HST_CMD), inb_p(SMB_HST_ADD), inb_p(SMB_HST_DAT0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) 		inb_p(SMB_HST_DAT1));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) 	if (timeout && !(data & HST_STS_BAD))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) 	if (timeout == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) 		status = -ETIMEDOUT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) 	if (data & HST_STS_DEVERR)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) 		status = -ENXIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) 	dev_err(&a->dev, "SMBus Error: %s%s%s%s%s\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) 		timeout ? "" : "Timeout ",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) 		data & HST_STS_FAIL ? "Transaction Failed " : "",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) 		data & HST_STS_BUSERR ? "No response or Bus Collision " : "",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) 		data & HST_STS_DEVERR ? "Device Error " : "",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) 		!(data & HST_STS_DONE) ? "Transaction Never Finished " : "");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) 	return status;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) static int ali1563_block(struct i2c_adapter *a,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) 			 union i2c_smbus_data *data, u8 rw)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) 	int i, len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) 	int error = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) 	/* Do we need this? */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) 	outb_p(HST_CNTL1_LAST, SMB_HST_CNTL1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) 	if (rw == I2C_SMBUS_WRITE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) 		len = data->block[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) 		if (len < 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) 			len = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) 		else if (len > 32)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) 			len = 32;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) 		outb_p(len, SMB_HST_DAT0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) 		outb_p(data->block[1], SMB_BLK_DAT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) 	} else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) 		len = 32;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) 	outb_p(inb_p(SMB_HST_CNTL2) | HST_CNTL2_BLOCK, SMB_HST_CNTL2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) 	for (i = 0; i < len; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) 		if (rw == I2C_SMBUS_WRITE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) 			outb_p(data->block[i + 1], SMB_BLK_DAT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) 			error = ali1563_block_start(a);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) 			if (error)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) 				break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) 		} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) 			error = ali1563_block_start(a);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) 			if (error)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) 				break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) 			if (i == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) 				len = inb_p(SMB_HST_DAT0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) 				if (len < 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) 					len = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) 				else if (len > 32)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) 					len = 32;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) 			data->block[i+1] = inb_p(SMB_BLK_DAT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) 	/* Do we need this? */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) 	outb_p(HST_CNTL1_LAST, SMB_HST_CNTL1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) 	return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) static s32 ali1563_access(struct i2c_adapter *a, u16 addr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) 			  unsigned short flags, char rw, u8 cmd,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) 			  int size, union i2c_smbus_data *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) 	int error = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) 	int timeout;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) 	u32 reg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) 	for (timeout = ALI1563_MAX_TIMEOUT; timeout; timeout--) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) 		reg = inb_p(SMB_HST_STS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) 		if (!(reg & HST_STS_BUSY))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) 	if (!timeout)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) 		dev_warn(&a->dev, "SMBus not idle. HST_STS = %02x\n", reg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) 	outb_p(0xff, SMB_HST_STS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) 	/* Map the size to what the chip understands */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) 	switch (size) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) 	case I2C_SMBUS_QUICK:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) 		size = HST_CNTL2_QUICK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) 	case I2C_SMBUS_BYTE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) 		size = HST_CNTL2_BYTE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) 	case I2C_SMBUS_BYTE_DATA:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) 		size = HST_CNTL2_BYTE_DATA;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) 	case I2C_SMBUS_WORD_DATA:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) 		size = HST_CNTL2_WORD_DATA;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) 	case I2C_SMBUS_BLOCK_DATA:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) 		size = HST_CNTL2_BLOCK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) 	default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) 		dev_warn(&a->dev, "Unsupported transaction %d\n", size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) 		error = -EOPNOTSUPP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) 		goto Done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) 	outb_p(((addr & 0x7f) << 1) | (rw & 0x01), SMB_HST_ADD);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) 	outb_p((inb_p(SMB_HST_CNTL2) & ~HST_CNTL2_SIZEMASK) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) 	       (size << 3), SMB_HST_CNTL2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) 	/* Write the command register */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) 	switch (size) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) 	case HST_CNTL2_BYTE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) 		if (rw == I2C_SMBUS_WRITE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) 			/* Beware it uses DAT0 register and not CMD! */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) 			outb_p(cmd, SMB_HST_DAT0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) 	case HST_CNTL2_BYTE_DATA:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) 		outb_p(cmd, SMB_HST_CMD);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) 		if (rw == I2C_SMBUS_WRITE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) 			outb_p(data->byte, SMB_HST_DAT0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) 	case HST_CNTL2_WORD_DATA:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) 		outb_p(cmd, SMB_HST_CMD);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) 		if (rw == I2C_SMBUS_WRITE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) 			outb_p(data->word & 0xff, SMB_HST_DAT0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) 			outb_p((data->word & 0xff00) >> 8, SMB_HST_DAT1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) 	case HST_CNTL2_BLOCK:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) 		outb_p(cmd, SMB_HST_CMD);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) 		error = ali1563_block(a, data, rw);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) 		goto Done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) 	error = ali1563_transaction(a, size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) 	if (error)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) 		goto Done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) 	if ((rw == I2C_SMBUS_WRITE) || (size == HST_CNTL2_QUICK))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) 		goto Done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) 	switch (size) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) 	case HST_CNTL2_BYTE:	/* Result put in SMBHSTDAT0 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) 		data->byte = inb_p(SMB_HST_DAT0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) 	case HST_CNTL2_BYTE_DATA:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) 		data->byte = inb_p(SMB_HST_DAT0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) 	case HST_CNTL2_WORD_DATA:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) 		data->word = inb_p(SMB_HST_DAT0) + (inb_p(SMB_HST_DAT1) << 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) Done:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) 	return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) static u32 ali1563_func(struct i2c_adapter *a)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) 	return I2C_FUNC_SMBUS_QUICK | I2C_FUNC_SMBUS_BYTE |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) 	    I2C_FUNC_SMBUS_BYTE_DATA | I2C_FUNC_SMBUS_WORD_DATA |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) 	    I2C_FUNC_SMBUS_BLOCK_DATA;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) static int ali1563_setup(struct pci_dev *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) 	u16 ctrl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) 	pci_read_config_word(dev, ALI1563_SMBBA, &ctrl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) 	/* SMB I/O Base in high 12 bits and must be aligned with the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) 	 * size of the I/O space. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) 	ali1563_smba = ctrl & ~(ALI1563_SMB_IOSIZE - 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) 	if (!ali1563_smba) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) 		dev_warn(&dev->dev, "ali1563_smba Uninitialized\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) 		goto Err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) 	/* Check if device is enabled */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) 	if (!(ctrl & ALI1563_SMB_HOSTEN)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) 		dev_warn(&dev->dev, "Host Controller not enabled\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) 		goto Err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) 	if (!(ctrl & ALI1563_SMB_IOEN)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) 		dev_warn(&dev->dev, "I/O space not enabled, trying manually\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) 		pci_write_config_word(dev, ALI1563_SMBBA,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) 				      ctrl | ALI1563_SMB_IOEN);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) 		pci_read_config_word(dev, ALI1563_SMBBA, &ctrl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) 		if (!(ctrl & ALI1563_SMB_IOEN)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) 			dev_err(&dev->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) 				"I/O space still not enabled, giving up\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) 			goto Err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) 	if (acpi_check_region(ali1563_smba, ALI1563_SMB_IOSIZE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) 			      ali1563_pci_driver.name))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) 		goto Err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) 	if (!request_region(ali1563_smba, ALI1563_SMB_IOSIZE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) 			    ali1563_pci_driver.name)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) 		dev_err(&dev->dev, "Could not allocate I/O space at 0x%04x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) 			ali1563_smba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) 		goto Err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) 	dev_info(&dev->dev, "Found ALi1563 SMBus at 0x%04x\n", ali1563_smba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) Err:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) 	return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) static void ali1563_shutdown(struct pci_dev *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) 	release_region(ali1563_smba, ALI1563_SMB_IOSIZE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) static const struct i2c_algorithm ali1563_algorithm = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) 	.smbus_xfer	= ali1563_access,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) 	.functionality	= ali1563_func,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) static struct i2c_adapter ali1563_adapter = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) 	.owner	= THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) 	.class	= I2C_CLASS_HWMON | I2C_CLASS_SPD,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) 	.algo	= &ali1563_algorithm,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) static int ali1563_probe(struct pci_dev *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) 			 const struct pci_device_id *id_table)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) 	int error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) 	error = ali1563_setup(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) 	if (error)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) 		goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) 	ali1563_adapter.dev.parent = &dev->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) 	snprintf(ali1563_adapter.name, sizeof(ali1563_adapter.name),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) 		 "SMBus ALi 1563 Adapter @ %04x", ali1563_smba);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) 	error = i2c_add_adapter(&ali1563_adapter);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) 	if (error)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) 		goto exit_shutdown;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) exit_shutdown:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) 	ali1563_shutdown(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) exit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) 	dev_warn(&dev->dev, "ALi1563 SMBus probe failed (%d)\n", error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) 	return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) static void ali1563_remove(struct pci_dev *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) 	i2c_del_adapter(&ali1563_adapter);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) 	ali1563_shutdown(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) static const struct pci_device_id ali1563_id_table[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) 	{ PCI_DEVICE(PCI_VENDOR_ID_AL, PCI_DEVICE_ID_AL_M1563) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) 	{},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) MODULE_DEVICE_TABLE(pci, ali1563_id_table);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) static struct pci_driver ali1563_pci_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) 	.name		= "ali1563_smbus",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) 	.id_table	= ali1563_id_table,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) 	.probe		= ali1563_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) 	.remove		= ali1563_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) module_pci_driver(ali1563_pci_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) MODULE_LICENSE("GPL");