[linux-block.git] / drivers / i2c / busses / i2c-ali1563.c

// SPDX-License-Identifier: GPL-2.0-only
/*
 *	i2c-ali1563.c - i2c driver for the ALi 1563 Southbridge
 *
 *	Copyright (C) 2004 Patrick Mochel
 *		      2005 Rudolf Marek <r.marek@assembler.cz>
 *
 *	The 1563 southbridge is deceptively similar to the 1533, with a
 *	few notable exceptions. One of those happens to be the fact they
 *	upgraded the i2c core to be 2.0 compliant, and happens to be almost
 *	identical to the i2c controller found in the Intel 801 south
 *	bridges.
 *
 *	This driver is based on a mix of the 15x3, 1535, and i801 drivers,
 *	with a little help from the ALi 1563 spec.
 */

#include <linux/module.h>
#include <linux/delay.h>
#include <linux/i2c.h>
#include <linux/pci.h>
#include <linux/acpi.h>

#define ALI1563_MAX_TIMEOUT	500
#define	ALI1563_SMBBA		0x80
#define ALI1563_SMB_IOEN	1
#define ALI1563_SMB_HOSTEN	2
#define ALI1563_SMB_IOSIZE	16

#define SMB_HST_STS	(ali1563_smba + 0)
#define SMB_HST_CNTL1	(ali1563_smba + 1)
#define SMB_HST_CNTL2	(ali1563_smba + 2)
#define SMB_HST_CMD	(ali1563_smba + 3)
#define SMB_HST_ADD	(ali1563_smba + 4)
#define SMB_HST_DAT0	(ali1563_smba + 5)
#define SMB_HST_DAT1	(ali1563_smba + 6)
#define SMB_BLK_DAT	(ali1563_smba + 7)

#define HST_STS_BUSY	0x01
#define HST_STS_INTR	0x02
#define HST_STS_DEVERR	0x04
#define HST_STS_BUSERR	0x08
#define HST_STS_FAIL	0x10
#define HST_STS_DONE	0x80
#define HST_STS_BAD	0x1c


#define HST_CNTL1_TIMEOUT	0x80
#define HST_CNTL1_LAST		0x40

#define HST_CNTL2_KILL		0x04
#define HST_CNTL2_START		0x40
#define HST_CNTL2_QUICK		0x00
#define HST_CNTL2_BYTE		0x01
#define HST_CNTL2_BYTE_DATA	0x02
#define HST_CNTL2_WORD_DATA	0x03
#define HST_CNTL2_BLOCK		0x05


#define HST_CNTL2_SIZEMASK	0x38

static struct pci_driver ali1563_pci_driver;
static unsigned short ali1563_smba;

static int ali1563_transaction(struct i2c_adapter *a, int size)
{
	u32 data;
	int timeout;
	int status = -EIO;

	dev_dbg(&a->dev, "Transaction (pre): STS=%02x, CNTL1=%02x, "
		"CNTL2=%02x, CMD=%02x, ADD=%02x, DAT0=%02x, DAT1=%02x\n",
		inb_p(SMB_HST_STS), inb_p(SMB_HST_CNTL1), inb_p(SMB_HST_CNTL2),
		inb_p(SMB_HST_CMD), inb_p(SMB_HST_ADD), inb_p(SMB_HST_DAT0),
		inb_p(SMB_HST_DAT1));

	data = inb_p(SMB_HST_STS);
	if (data & HST_STS_BAD) {
		dev_err(&a->dev, "ali1563: Trying to reset busy device\n");
		outb_p(data | HST_STS_BAD, SMB_HST_STS);
		data = inb_p(SMB_HST_STS);
		if (data & HST_STS_BAD)
			return -EBUSY;
	}
	outb_p(inb_p(SMB_HST_CNTL2) | HST_CNTL2_START, SMB_HST_CNTL2);

	timeout = ALI1563_MAX_TIMEOUT;
	do {
		msleep(1);
	} while (((data = inb_p(SMB_HST_STS)) & HST_STS_BUSY) && --timeout);

	dev_dbg(&a->dev, "Transaction (post): STS=%02x, CNTL1=%02x, "
		"CNTL2=%02x, CMD=%02x, ADD=%02x, DAT0=%02x, DAT1=%02x\n",
		inb_p(SMB_HST_STS), inb_p(SMB_HST_CNTL1), inb_p(SMB_HST_CNTL2),
		inb_p(SMB_HST_CMD), inb_p(SMB_HST_ADD), inb_p(SMB_HST_DAT0),
		inb_p(SMB_HST_DAT1));

	if (timeout && !(data & HST_STS_BAD))
		return 0;

	if (!timeout) {
		/* Issue 'kill' to host controller */
		outb_p(HST_CNTL2_KILL, SMB_HST_CNTL2);
		data = inb_p(SMB_HST_STS);
		status = -ETIMEDOUT;
	}

	/* device error - no response, ignore the autodetection case */
	if (data & HST_STS_DEVERR) {
		if (size != HST_CNTL2_QUICK)
			dev_err(&a->dev, "Device error!\n");
		status = -ENXIO;
	}
	/* bus collision */
	if (data & HST_STS_BUSERR) {
		dev_err(&a->dev, "Bus collision!\n");
		/* Issue timeout, hoping it helps */
		outb_p(HST_CNTL1_TIMEOUT, SMB_HST_CNTL1);
	}

	if (data & HST_STS_FAIL) {
		dev_err(&a->dev, "Cleaning fail after KILL!\n");
		outb_p(0x0, SMB_HST_CNTL2);
	}

	return status;
}

static int ali1563_block_start(struct i2c_adapter *a)
{
	u32 data;
	int timeout;
	int status = -EIO;

	dev_dbg(&a->dev, "Block (pre): STS=%02x, CNTL1=%02x, "
		"CNTL2=%02x, CMD=%02x, ADD=%02x, DAT0=%02x, DAT1=%02x\n",
		inb_p(SMB_HST_STS), inb_p(SMB_HST_CNTL1), inb_p(SMB_HST_CNTL2),
		inb_p(SMB_HST_CMD), inb_p(SMB_HST_ADD), inb_p(SMB_HST_DAT0),
		inb_p(SMB_HST_DAT1));

	data = inb_p(SMB_HST_STS);
	if (data & HST_STS_BAD) {
		dev_warn(&a->dev, "ali1563: Trying to reset busy device\n");
		outb_p(data | HST_STS_BAD, SMB_HST_STS);
		data = inb_p(SMB_HST_STS);
		if (data & HST_STS_BAD)
			return -EBUSY;
	}

	/* Clear byte-ready bit */
	outb_p(data | HST_STS_DONE, SMB_HST_STS);

	/* Start transaction and wait for byte-ready bit to be set */
	outb_p(inb_p(SMB_HST_CNTL2) | HST_CNTL2_START, SMB_HST_CNTL2);

	timeout = ALI1563_MAX_TIMEOUT;
	do {
		msleep(1);
	} while (!((data = inb_p(SMB_HST_STS)) & HST_STS_DONE) && --timeout);

	dev_dbg(&a->dev, "Block (post): STS=%02x, CNTL1=%02x, "
		"CNTL2=%02x, CMD=%02x, ADD=%02x, DAT0=%02x, DAT1=%02x\n",
		inb_p(SMB_HST_STS), inb_p(SMB_HST_CNTL1), inb_p(SMB_HST_CNTL2),
		inb_p(SMB_HST_CMD), inb_p(SMB_HST_ADD), inb_p(SMB_HST_DAT0),
		inb_p(SMB_HST_DAT1));

	if (timeout && !(data & HST_STS_BAD))
		return 0;

	if (timeout == 0)
		status = -ETIMEDOUT;

	if (data & HST_STS_DEVERR)
		status = -ENXIO;

	dev_err(&a->dev, "SMBus Error: %s%s%s%s%s\n",
		timeout ? "" : "Timeout ",
		data & HST_STS_FAIL ? "Transaction Failed " : "",
		data & HST_STS_BUSERR ? "No response or Bus Collision " : "",
		data & HST_STS_DEVERR ? "Device Error " : "",
		!(data & HST_STS_DONE) ? "Transaction Never Finished " : "");
	return status;
}

static int ali1563_block(struct i2c_adapter *a,
			 union i2c_smbus_data *data, u8 rw)
{
	int i, len;
	int error = 0;

	/* Do we need this? */
	outb_p(HST_CNTL1_LAST, SMB_HST_CNTL1);

	if (rw == I2C_SMBUS_WRITE) {
		len = data->block[0];
		if (len < 1)
			len = 1;
		else if (len > 32)
			len = 32;
		outb_p(len, SMB_HST_DAT0);
		outb_p(data->block[1], SMB_BLK_DAT);
	} else
		len = 32;

	outb_p(inb_p(SMB_HST_CNTL2) | HST_CNTL2_BLOCK, SMB_HST_CNTL2);

	for (i = 0; i < len; i++) {
		if (rw == I2C_SMBUS_WRITE) {
			outb_p(data->block[i + 1], SMB_BLK_DAT);
			error = ali1563_block_start(a);
			if (error)
				break;
		} else {
			error = ali1563_block_start(a);
			if (error)
				break;
			if (i == 0) {
				len = inb_p(SMB_HST_DAT0);
				if (len < 1)
					len = 1;
				else if (len > 32)
					len = 32;
			}
			data->block[i+1] = inb_p(SMB_BLK_DAT);
		}
	}
	/* Do we need this? */
	outb_p(HST_CNTL1_LAST, SMB_HST_CNTL1);
	return error;
}

static s32 ali1563_access(struct i2c_adapter *a, u16 addr,
			  unsigned short flags, char rw, u8 cmd,
			  int size, union i2c_smbus_data *data)
{
	int error = 0;
	int timeout;
	u32 reg;

	for (timeout = ALI1563_MAX_TIMEOUT; timeout; timeout--) {
		reg = inb_p(SMB_HST_STS);
		if (!(reg & HST_STS_BUSY))
			break;
	}
	if (!timeout)
		dev_warn(&a->dev, "SMBus not idle. HST_STS = %02x\n", reg);
	outb_p(0xff, SMB_HST_STS);

	/* Map the size to what the chip understands */
	switch (size) {
	case I2C_SMBUS_QUICK:
		size = HST_CNTL2_QUICK;
		break;
	case I2C_SMBUS_BYTE:
		size = HST_CNTL2_BYTE;
		break;
	case I2C_SMBUS_BYTE_DATA:
		size = HST_CNTL2_BYTE_DATA;
		break;
	case I2C_SMBUS_WORD_DATA:
		size = HST_CNTL2_WORD_DATA;
		break;
	case I2C_SMBUS_BLOCK_DATA:
		size = HST_CNTL2_BLOCK;
		break;
	default:
		dev_warn(&a->dev, "Unsupported transaction %d\n", size);
		error = -EOPNOTSUPP;
		goto Done;
	}

	outb_p(((addr & 0x7f) << 1) | (rw & 0x01), SMB_HST_ADD);
	outb_p((inb_p(SMB_HST_CNTL2) & ~HST_CNTL2_SIZEMASK) |
	       (size << 3), SMB_HST_CNTL2);

	/* Write the command register */

	switch (size) {
	case HST_CNTL2_BYTE:
		if (rw == I2C_SMBUS_WRITE)
			/* Beware it uses DAT0 register and not CMD! */
			outb_p(cmd, SMB_HST_DAT0);
		break;
	case HST_CNTL2_BYTE_DATA:
		outb_p(cmd, SMB_HST_CMD);
		if (rw == I2C_SMBUS_WRITE)
			outb_p(data->byte, SMB_HST_DAT0);
		break;
	case HST_CNTL2_WORD_DATA:
		outb_p(cmd, SMB_HST_CMD);
		if (rw == I2C_SMBUS_WRITE) {
			outb_p(data->word & 0xff, SMB_HST_DAT0);
			outb_p((data->word & 0xff00) >> 8, SMB_HST_DAT1);
		}
		break;
	case HST_CNTL2_BLOCK:
		outb_p(cmd, SMB_HST_CMD);
		error = ali1563_block(a, data, rw);
		goto Done;
	}

	error = ali1563_transaction(a, size);
	if (error)
		goto Done;

	if ((rw == I2C_SMBUS_WRITE) || (size == HST_CNTL2_QUICK))
		goto Done;

	switch (size) {
	case HST_CNTL2_BYTE:	/* Result put in SMBHSTDAT0 */
		data->byte = inb_p(SMB_HST_DAT0);
		break;
	case HST_CNTL2_BYTE_DATA:
		data->byte = inb_p(SMB_HST_DAT0);
		break;
	case HST_CNTL2_WORD_DATA:
		data->word = inb_p(SMB_HST_DAT0) + (inb_p(SMB_HST_DAT1) << 8);
		break;
	}
Done:
	return error;
}

static u32 ali1563_func(struct i2c_adapter *a)
{
	return I2C_FUNC_SMBUS_QUICK | I2C_FUNC_SMBUS_BYTE |
	    I2C_FUNC_SMBUS_BYTE_DATA | I2C_FUNC_SMBUS_WORD_DATA |
	    I2C_FUNC_SMBUS_BLOCK_DATA;
}


static int ali1563_setup(struct pci_dev *dev)
{
	u16 ctrl;

	pci_read_config_word(dev, ALI1563_SMBBA, &ctrl);

	/* SMB I/O Base in high 12 bits and must be aligned with the
	 * size of the I/O space. */
	ali1563_smba = ctrl & ~(ALI1563_SMB_IOSIZE - 1);
	if (!ali1563_smba) {
		dev_warn(&dev->dev, "ali1563_smba Uninitialized\n");
		goto Err;
	}

	/* Check if device is enabled */
	if (!(ctrl & ALI1563_SMB_HOSTEN)) {
		dev_warn(&dev->dev, "Host Controller not enabled\n");
		goto Err;
	}
	if (!(ctrl & ALI1563_SMB_IOEN)) {
		dev_warn(&dev->dev, "I/O space not enabled, trying manually\n");
		pci_write_config_word(dev, ALI1563_SMBBA,
				      ctrl | ALI1563_SMB_IOEN);
		pci_read_config_word(dev, ALI1563_SMBBA, &ctrl);
		if (!(ctrl & ALI1563_SMB_IOEN)) {
			dev_err(&dev->dev,
				"I/O space still not enabled, giving up\n");
			goto Err;
		}
	}

	if (acpi_check_region(ali1563_smba, ALI1563_SMB_IOSIZE,
			      ali1563_pci_driver.name))
		goto Err;

	if (!request_region(ali1563_smba, ALI1563_SMB_IOSIZE,
			    ali1563_pci_driver.name)) {
		dev_err(&dev->dev, "Could not allocate I/O space at 0x%04x\n",
			ali1563_smba);
		goto Err;
	}
	dev_info(&dev->dev, "Found ALi1563 SMBus at 0x%04x\n", ali1563_smba);

	return 0;
Err:
	return -ENODEV;
}

static void ali1563_shutdown(struct pci_dev *dev)
{
	release_region(ali1563_smba, ALI1563_SMB_IOSIZE);
}

static const struct i2c_algorithm ali1563_algorithm = {
	.smbus_xfer	= ali1563_access,
	.functionality	= ali1563_func,
};

static struct i2c_adapter ali1563_adapter = {
	.owner	= THIS_MODULE,
	.class	= I2C_CLASS_HWMON,
	.algo	= &ali1563_algorithm,
};

static int ali1563_probe(struct pci_dev *dev,
			 const struct pci_device_id *id_table)
{
	int error;

	error = ali1563_setup(dev);
	if (error)
		goto exit;
	ali1563_adapter.dev.parent = &dev->dev;
	snprintf(ali1563_adapter.name, sizeof(ali1563_adapter.name),
		 "SMBus ALi 1563 Adapter @ %04x", ali1563_smba);
	error = i2c_add_adapter(&ali1563_adapter);
	if (error)
		goto exit_shutdown;
	return 0;

exit_shutdown:
	ali1563_shutdown(dev);
exit:
	dev_warn(&dev->dev, "ALi1563 SMBus probe failed (%d)\n", error);
	return error;
}

static void ali1563_remove(struct pci_dev *dev)
{
	i2c_del_adapter(&ali1563_adapter);
	ali1563_shutdown(dev);
}

static const struct pci_device_id ali1563_id_table[] = {
	{ PCI_DEVICE(PCI_VENDOR_ID_AL, PCI_DEVICE_ID_AL_M1563) },
	{},
};

MODULE_DEVICE_TABLE(pci, ali1563_id_table);

static struct pci_driver ali1563_pci_driver = {
	.name		= "ali1563_smbus",
	.id_table	= ali1563_id_table,
	.probe		= ali1563_probe,
	.remove		= ali1563_remove,
};

module_pci_driver(ali1563_pci_driver);

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