162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci *  i2c-algo-pca.c i2c driver algorithms for PCA9564 adapters
462306a36Sopenharmony_ci *    Copyright (C) 2004 Arcom Control Systems
562306a36Sopenharmony_ci *    Copyright (C) 2008 Pengutronix
662306a36Sopenharmony_ci */
762306a36Sopenharmony_ci
862306a36Sopenharmony_ci#include <linux/kernel.h>
962306a36Sopenharmony_ci#include <linux/module.h>
1062306a36Sopenharmony_ci#include <linux/moduleparam.h>
1162306a36Sopenharmony_ci#include <linux/delay.h>
1262306a36Sopenharmony_ci#include <linux/jiffies.h>
1362306a36Sopenharmony_ci#include <linux/errno.h>
1462306a36Sopenharmony_ci#include <linux/i2c.h>
1562306a36Sopenharmony_ci#include <linux/i2c-algo-pca.h>
1662306a36Sopenharmony_ci
1762306a36Sopenharmony_ci#define DEB1(fmt, args...) do { if (i2c_debug >= 1)			\
1862306a36Sopenharmony_ci				 printk(KERN_DEBUG fmt, ## args); } while (0)
1962306a36Sopenharmony_ci#define DEB2(fmt, args...) do { if (i2c_debug >= 2)			\
2062306a36Sopenharmony_ci				 printk(KERN_DEBUG fmt, ## args); } while (0)
2162306a36Sopenharmony_ci#define DEB3(fmt, args...) do { if (i2c_debug >= 3)			\
2262306a36Sopenharmony_ci				 printk(KERN_DEBUG fmt, ## args); } while (0)
2362306a36Sopenharmony_ci
2462306a36Sopenharmony_cistatic int i2c_debug;
2562306a36Sopenharmony_ci
2662306a36Sopenharmony_ci#define pca_outw(adap, reg, val) adap->write_byte(adap->data, reg, val)
2762306a36Sopenharmony_ci#define pca_inw(adap, reg) adap->read_byte(adap->data, reg)
2862306a36Sopenharmony_ci
2962306a36Sopenharmony_ci#define pca_status(adap) pca_inw(adap, I2C_PCA_STA)
3062306a36Sopenharmony_ci#define pca_clock(adap) adap->i2c_clock
3162306a36Sopenharmony_ci#define pca_set_con(adap, val) pca_outw(adap, I2C_PCA_CON, val)
3262306a36Sopenharmony_ci#define pca_get_con(adap) pca_inw(adap, I2C_PCA_CON)
3362306a36Sopenharmony_ci#define pca_wait(adap) adap->wait_for_completion(adap->data)
3462306a36Sopenharmony_ci
3562306a36Sopenharmony_cistatic void pca_reset(struct i2c_algo_pca_data *adap)
3662306a36Sopenharmony_ci{
3762306a36Sopenharmony_ci	if (adap->chip == I2C_PCA_CHIP_9665) {
3862306a36Sopenharmony_ci		/* Ignore the reset function from the module,
3962306a36Sopenharmony_ci		 * we can use the parallel bus reset.
4062306a36Sopenharmony_ci		 */
4162306a36Sopenharmony_ci		pca_outw(adap, I2C_PCA_INDPTR, I2C_PCA_IPRESET);
4262306a36Sopenharmony_ci		pca_outw(adap, I2C_PCA_IND, 0xA5);
4362306a36Sopenharmony_ci		pca_outw(adap, I2C_PCA_IND, 0x5A);
4462306a36Sopenharmony_ci
4562306a36Sopenharmony_ci		/*
4662306a36Sopenharmony_ci		 * After a reset we need to re-apply any configuration
4762306a36Sopenharmony_ci		 * (calculated in pca_init) to get the bus in a working state.
4862306a36Sopenharmony_ci		 */
4962306a36Sopenharmony_ci		pca_outw(adap, I2C_PCA_INDPTR, I2C_PCA_IMODE);
5062306a36Sopenharmony_ci		pca_outw(adap, I2C_PCA_IND, adap->bus_settings.mode);
5162306a36Sopenharmony_ci		pca_outw(adap, I2C_PCA_INDPTR, I2C_PCA_ISCLL);
5262306a36Sopenharmony_ci		pca_outw(adap, I2C_PCA_IND, adap->bus_settings.tlow);
5362306a36Sopenharmony_ci		pca_outw(adap, I2C_PCA_INDPTR, I2C_PCA_ISCLH);
5462306a36Sopenharmony_ci		pca_outw(adap, I2C_PCA_IND, adap->bus_settings.thi);
5562306a36Sopenharmony_ci
5662306a36Sopenharmony_ci		pca_set_con(adap, I2C_PCA_CON_ENSIO);
5762306a36Sopenharmony_ci	} else {
5862306a36Sopenharmony_ci		adap->reset_chip(adap->data);
5962306a36Sopenharmony_ci		pca_set_con(adap, I2C_PCA_CON_ENSIO | adap->bus_settings.clock_freq);
6062306a36Sopenharmony_ci	}
6162306a36Sopenharmony_ci}
6262306a36Sopenharmony_ci
6362306a36Sopenharmony_ci/*
6462306a36Sopenharmony_ci * Generate a start condition on the i2c bus.
6562306a36Sopenharmony_ci *
6662306a36Sopenharmony_ci * returns after the start condition has occurred
6762306a36Sopenharmony_ci */
6862306a36Sopenharmony_cistatic int pca_start(struct i2c_algo_pca_data *adap)
6962306a36Sopenharmony_ci{
7062306a36Sopenharmony_ci	int sta = pca_get_con(adap);
7162306a36Sopenharmony_ci	DEB2("=== START\n");
7262306a36Sopenharmony_ci	sta |= I2C_PCA_CON_STA;
7362306a36Sopenharmony_ci	sta &= ~(I2C_PCA_CON_STO|I2C_PCA_CON_SI);
7462306a36Sopenharmony_ci	pca_set_con(adap, sta);
7562306a36Sopenharmony_ci	return pca_wait(adap);
7662306a36Sopenharmony_ci}
7762306a36Sopenharmony_ci
7862306a36Sopenharmony_ci/*
7962306a36Sopenharmony_ci * Generate a repeated start condition on the i2c bus
8062306a36Sopenharmony_ci *
8162306a36Sopenharmony_ci * return after the repeated start condition has occurred
8262306a36Sopenharmony_ci */
8362306a36Sopenharmony_cistatic int pca_repeated_start(struct i2c_algo_pca_data *adap)
8462306a36Sopenharmony_ci{
8562306a36Sopenharmony_ci	int sta = pca_get_con(adap);
8662306a36Sopenharmony_ci	DEB2("=== REPEATED START\n");
8762306a36Sopenharmony_ci	sta |= I2C_PCA_CON_STA;
8862306a36Sopenharmony_ci	sta &= ~(I2C_PCA_CON_STO|I2C_PCA_CON_SI);
8962306a36Sopenharmony_ci	pca_set_con(adap, sta);
9062306a36Sopenharmony_ci	return pca_wait(adap);
9162306a36Sopenharmony_ci}
9262306a36Sopenharmony_ci
9362306a36Sopenharmony_ci/*
9462306a36Sopenharmony_ci * Generate a stop condition on the i2c bus
9562306a36Sopenharmony_ci *
9662306a36Sopenharmony_ci * returns after the stop condition has been generated
9762306a36Sopenharmony_ci *
9862306a36Sopenharmony_ci * STOPs do not generate an interrupt or set the SI flag, since the
9962306a36Sopenharmony_ci * part returns the idle state (0xf8). Hence we don't need to
10062306a36Sopenharmony_ci * pca_wait here.
10162306a36Sopenharmony_ci */
10262306a36Sopenharmony_cistatic void pca_stop(struct i2c_algo_pca_data *adap)
10362306a36Sopenharmony_ci{
10462306a36Sopenharmony_ci	int sta = pca_get_con(adap);
10562306a36Sopenharmony_ci	DEB2("=== STOP\n");
10662306a36Sopenharmony_ci	sta |= I2C_PCA_CON_STO;
10762306a36Sopenharmony_ci	sta &= ~(I2C_PCA_CON_STA|I2C_PCA_CON_SI);
10862306a36Sopenharmony_ci	pca_set_con(adap, sta);
10962306a36Sopenharmony_ci}
11062306a36Sopenharmony_ci
11162306a36Sopenharmony_ci/*
11262306a36Sopenharmony_ci * Send the slave address and R/W bit
11362306a36Sopenharmony_ci *
11462306a36Sopenharmony_ci * returns after the address has been sent
11562306a36Sopenharmony_ci */
11662306a36Sopenharmony_cistatic int pca_address(struct i2c_algo_pca_data *adap,
11762306a36Sopenharmony_ci		       struct i2c_msg *msg)
11862306a36Sopenharmony_ci{
11962306a36Sopenharmony_ci	int sta = pca_get_con(adap);
12062306a36Sopenharmony_ci	int addr = i2c_8bit_addr_from_msg(msg);
12162306a36Sopenharmony_ci
12262306a36Sopenharmony_ci	DEB2("=== SLAVE ADDRESS %#04x+%c=%#04x\n",
12362306a36Sopenharmony_ci	     msg->addr, msg->flags & I2C_M_RD ? 'R' : 'W', addr);
12462306a36Sopenharmony_ci
12562306a36Sopenharmony_ci	pca_outw(adap, I2C_PCA_DAT, addr);
12662306a36Sopenharmony_ci
12762306a36Sopenharmony_ci	sta &= ~(I2C_PCA_CON_STO|I2C_PCA_CON_STA|I2C_PCA_CON_SI);
12862306a36Sopenharmony_ci	pca_set_con(adap, sta);
12962306a36Sopenharmony_ci
13062306a36Sopenharmony_ci	return pca_wait(adap);
13162306a36Sopenharmony_ci}
13262306a36Sopenharmony_ci
13362306a36Sopenharmony_ci/*
13462306a36Sopenharmony_ci * Transmit a byte.
13562306a36Sopenharmony_ci *
13662306a36Sopenharmony_ci * Returns after the byte has been transmitted
13762306a36Sopenharmony_ci */
13862306a36Sopenharmony_cistatic int pca_tx_byte(struct i2c_algo_pca_data *adap,
13962306a36Sopenharmony_ci		       __u8 b)
14062306a36Sopenharmony_ci{
14162306a36Sopenharmony_ci	int sta = pca_get_con(adap);
14262306a36Sopenharmony_ci	DEB2("=== WRITE %#04x\n", b);
14362306a36Sopenharmony_ci	pca_outw(adap, I2C_PCA_DAT, b);
14462306a36Sopenharmony_ci
14562306a36Sopenharmony_ci	sta &= ~(I2C_PCA_CON_STO|I2C_PCA_CON_STA|I2C_PCA_CON_SI);
14662306a36Sopenharmony_ci	pca_set_con(adap, sta);
14762306a36Sopenharmony_ci
14862306a36Sopenharmony_ci	return pca_wait(adap);
14962306a36Sopenharmony_ci}
15062306a36Sopenharmony_ci
15162306a36Sopenharmony_ci/*
15262306a36Sopenharmony_ci * Receive a byte
15362306a36Sopenharmony_ci *
15462306a36Sopenharmony_ci * returns immediately.
15562306a36Sopenharmony_ci */
15662306a36Sopenharmony_cistatic void pca_rx_byte(struct i2c_algo_pca_data *adap,
15762306a36Sopenharmony_ci			__u8 *b, int ack)
15862306a36Sopenharmony_ci{
15962306a36Sopenharmony_ci	*b = pca_inw(adap, I2C_PCA_DAT);
16062306a36Sopenharmony_ci	DEB2("=== READ %#04x %s\n", *b, ack ? "ACK" : "NACK");
16162306a36Sopenharmony_ci}
16262306a36Sopenharmony_ci
16362306a36Sopenharmony_ci/*
16462306a36Sopenharmony_ci * Setup ACK or NACK for next received byte and wait for it to arrive.
16562306a36Sopenharmony_ci *
16662306a36Sopenharmony_ci * Returns after next byte has arrived.
16762306a36Sopenharmony_ci */
16862306a36Sopenharmony_cistatic int pca_rx_ack(struct i2c_algo_pca_data *adap,
16962306a36Sopenharmony_ci		      int ack)
17062306a36Sopenharmony_ci{
17162306a36Sopenharmony_ci	int sta = pca_get_con(adap);
17262306a36Sopenharmony_ci
17362306a36Sopenharmony_ci	sta &= ~(I2C_PCA_CON_STO|I2C_PCA_CON_STA|I2C_PCA_CON_SI|I2C_PCA_CON_AA);
17462306a36Sopenharmony_ci
17562306a36Sopenharmony_ci	if (ack)
17662306a36Sopenharmony_ci		sta |= I2C_PCA_CON_AA;
17762306a36Sopenharmony_ci
17862306a36Sopenharmony_ci	pca_set_con(adap, sta);
17962306a36Sopenharmony_ci	return pca_wait(adap);
18062306a36Sopenharmony_ci}
18162306a36Sopenharmony_ci
18262306a36Sopenharmony_cistatic int pca_xfer(struct i2c_adapter *i2c_adap,
18362306a36Sopenharmony_ci		    struct i2c_msg *msgs,
18462306a36Sopenharmony_ci		    int num)
18562306a36Sopenharmony_ci{
18662306a36Sopenharmony_ci	struct i2c_algo_pca_data *adap = i2c_adap->algo_data;
18762306a36Sopenharmony_ci	struct i2c_msg *msg = NULL;
18862306a36Sopenharmony_ci	int curmsg;
18962306a36Sopenharmony_ci	int numbytes = 0;
19062306a36Sopenharmony_ci	int state;
19162306a36Sopenharmony_ci	int ret;
19262306a36Sopenharmony_ci	int completed = 1;
19362306a36Sopenharmony_ci	unsigned long timeout = jiffies + i2c_adap->timeout;
19462306a36Sopenharmony_ci
19562306a36Sopenharmony_ci	while ((state = pca_status(adap)) != 0xf8) {
19662306a36Sopenharmony_ci		if (time_before(jiffies, timeout)) {
19762306a36Sopenharmony_ci			msleep(10);
19862306a36Sopenharmony_ci		} else {
19962306a36Sopenharmony_ci			dev_dbg(&i2c_adap->dev, "bus is not idle. status is "
20062306a36Sopenharmony_ci				"%#04x\n", state);
20162306a36Sopenharmony_ci			return -EBUSY;
20262306a36Sopenharmony_ci		}
20362306a36Sopenharmony_ci	}
20462306a36Sopenharmony_ci
20562306a36Sopenharmony_ci	DEB1("{{{ XFER %d messages\n", num);
20662306a36Sopenharmony_ci
20762306a36Sopenharmony_ci	if (i2c_debug >= 2) {
20862306a36Sopenharmony_ci		for (curmsg = 0; curmsg < num; curmsg++) {
20962306a36Sopenharmony_ci			int addr, i;
21062306a36Sopenharmony_ci			msg = &msgs[curmsg];
21162306a36Sopenharmony_ci
21262306a36Sopenharmony_ci			addr = (0x7f & msg->addr) ;
21362306a36Sopenharmony_ci
21462306a36Sopenharmony_ci			if (msg->flags & I2C_M_RD)
21562306a36Sopenharmony_ci				printk(KERN_INFO "    [%02d] RD %d bytes from %#02x [%#02x, ...]\n",
21662306a36Sopenharmony_ci				       curmsg, msg->len, addr, (addr << 1) | 1);
21762306a36Sopenharmony_ci			else {
21862306a36Sopenharmony_ci				printk(KERN_INFO "    [%02d] WR %d bytes to %#02x [%#02x%s",
21962306a36Sopenharmony_ci				       curmsg, msg->len, addr, addr << 1,
22062306a36Sopenharmony_ci				       msg->len == 0 ? "" : ", ");
22162306a36Sopenharmony_ci				for (i = 0; i < msg->len; i++)
22262306a36Sopenharmony_ci					printk("%#04x%s", msg->buf[i], i == msg->len - 1 ? "" : ", ");
22362306a36Sopenharmony_ci				printk("]\n");
22462306a36Sopenharmony_ci			}
22562306a36Sopenharmony_ci		}
22662306a36Sopenharmony_ci	}
22762306a36Sopenharmony_ci
22862306a36Sopenharmony_ci	curmsg = 0;
22962306a36Sopenharmony_ci	ret = -EIO;
23062306a36Sopenharmony_ci	while (curmsg < num) {
23162306a36Sopenharmony_ci		state = pca_status(adap);
23262306a36Sopenharmony_ci
23362306a36Sopenharmony_ci		DEB3("STATE is 0x%02x\n", state);
23462306a36Sopenharmony_ci		msg = &msgs[curmsg];
23562306a36Sopenharmony_ci
23662306a36Sopenharmony_ci		switch (state) {
23762306a36Sopenharmony_ci		case 0xf8: /* On reset or stop the bus is idle */
23862306a36Sopenharmony_ci			completed = pca_start(adap);
23962306a36Sopenharmony_ci			break;
24062306a36Sopenharmony_ci
24162306a36Sopenharmony_ci		case 0x08: /* A START condition has been transmitted */
24262306a36Sopenharmony_ci		case 0x10: /* A repeated start condition has been transmitted */
24362306a36Sopenharmony_ci			completed = pca_address(adap, msg);
24462306a36Sopenharmony_ci			break;
24562306a36Sopenharmony_ci
24662306a36Sopenharmony_ci		case 0x18: /* SLA+W has been transmitted; ACK has been received */
24762306a36Sopenharmony_ci		case 0x28: /* Data byte in I2CDAT has been transmitted; ACK has been received */
24862306a36Sopenharmony_ci			if (numbytes < msg->len) {
24962306a36Sopenharmony_ci				completed = pca_tx_byte(adap,
25062306a36Sopenharmony_ci							msg->buf[numbytes]);
25162306a36Sopenharmony_ci				numbytes++;
25262306a36Sopenharmony_ci				break;
25362306a36Sopenharmony_ci			}
25462306a36Sopenharmony_ci			curmsg++; numbytes = 0;
25562306a36Sopenharmony_ci			if (curmsg == num)
25662306a36Sopenharmony_ci				pca_stop(adap);
25762306a36Sopenharmony_ci			else
25862306a36Sopenharmony_ci				completed = pca_repeated_start(adap);
25962306a36Sopenharmony_ci			break;
26062306a36Sopenharmony_ci
26162306a36Sopenharmony_ci		case 0x20: /* SLA+W has been transmitted; NOT ACK has been received */
26262306a36Sopenharmony_ci			DEB2("NOT ACK received after SLA+W\n");
26362306a36Sopenharmony_ci			pca_stop(adap);
26462306a36Sopenharmony_ci			ret = -ENXIO;
26562306a36Sopenharmony_ci			goto out;
26662306a36Sopenharmony_ci
26762306a36Sopenharmony_ci		case 0x40: /* SLA+R has been transmitted; ACK has been received */
26862306a36Sopenharmony_ci			completed = pca_rx_ack(adap, msg->len > 1);
26962306a36Sopenharmony_ci			break;
27062306a36Sopenharmony_ci
27162306a36Sopenharmony_ci		case 0x50: /* Data bytes has been received; ACK has been returned */
27262306a36Sopenharmony_ci			if (numbytes < msg->len) {
27362306a36Sopenharmony_ci				pca_rx_byte(adap, &msg->buf[numbytes], 1);
27462306a36Sopenharmony_ci				numbytes++;
27562306a36Sopenharmony_ci				completed = pca_rx_ack(adap,
27662306a36Sopenharmony_ci						       numbytes < msg->len - 1);
27762306a36Sopenharmony_ci				break;
27862306a36Sopenharmony_ci			}
27962306a36Sopenharmony_ci			curmsg++; numbytes = 0;
28062306a36Sopenharmony_ci			if (curmsg == num)
28162306a36Sopenharmony_ci				pca_stop(adap);
28262306a36Sopenharmony_ci			else
28362306a36Sopenharmony_ci				completed = pca_repeated_start(adap);
28462306a36Sopenharmony_ci			break;
28562306a36Sopenharmony_ci
28662306a36Sopenharmony_ci		case 0x48: /* SLA+R has been transmitted; NOT ACK has been received */
28762306a36Sopenharmony_ci			DEB2("NOT ACK received after SLA+R\n");
28862306a36Sopenharmony_ci			pca_stop(adap);
28962306a36Sopenharmony_ci			ret = -ENXIO;
29062306a36Sopenharmony_ci			goto out;
29162306a36Sopenharmony_ci
29262306a36Sopenharmony_ci		case 0x30: /* Data byte in I2CDAT has been transmitted; NOT ACK has been received */
29362306a36Sopenharmony_ci			DEB2("NOT ACK received after data byte\n");
29462306a36Sopenharmony_ci			pca_stop(adap);
29562306a36Sopenharmony_ci			goto out;
29662306a36Sopenharmony_ci
29762306a36Sopenharmony_ci		case 0x38: /* Arbitration lost during SLA+W, SLA+R or data bytes */
29862306a36Sopenharmony_ci			DEB2("Arbitration lost\n");
29962306a36Sopenharmony_ci			/*
30062306a36Sopenharmony_ci			 * The PCA9564 data sheet (2006-09-01) says "A
30162306a36Sopenharmony_ci			 * START condition will be transmitted when the
30262306a36Sopenharmony_ci			 * bus becomes free (STOP or SCL and SDA high)"
30362306a36Sopenharmony_ci			 * when the STA bit is set (p. 11).
30462306a36Sopenharmony_ci			 *
30562306a36Sopenharmony_ci			 * In case this won't work, try pca_reset()
30662306a36Sopenharmony_ci			 * instead.
30762306a36Sopenharmony_ci			 */
30862306a36Sopenharmony_ci			pca_start(adap);
30962306a36Sopenharmony_ci			goto out;
31062306a36Sopenharmony_ci
31162306a36Sopenharmony_ci		case 0x58: /* Data byte has been received; NOT ACK has been returned */
31262306a36Sopenharmony_ci			if (numbytes == msg->len - 1) {
31362306a36Sopenharmony_ci				pca_rx_byte(adap, &msg->buf[numbytes], 0);
31462306a36Sopenharmony_ci				curmsg++; numbytes = 0;
31562306a36Sopenharmony_ci				if (curmsg == num)
31662306a36Sopenharmony_ci					pca_stop(adap);
31762306a36Sopenharmony_ci				else
31862306a36Sopenharmony_ci					completed = pca_repeated_start(adap);
31962306a36Sopenharmony_ci			} else {
32062306a36Sopenharmony_ci				DEB2("NOT ACK sent after data byte received. "
32162306a36Sopenharmony_ci				     "Not final byte. numbytes %d. len %d\n",
32262306a36Sopenharmony_ci				     numbytes, msg->len);
32362306a36Sopenharmony_ci				pca_stop(adap);
32462306a36Sopenharmony_ci				goto out;
32562306a36Sopenharmony_ci			}
32662306a36Sopenharmony_ci			break;
32762306a36Sopenharmony_ci		case 0x70: /* Bus error - SDA stuck low */
32862306a36Sopenharmony_ci			DEB2("BUS ERROR - SDA Stuck low\n");
32962306a36Sopenharmony_ci			pca_reset(adap);
33062306a36Sopenharmony_ci			goto out;
33162306a36Sopenharmony_ci		case 0x78: /* Bus error - SCL stuck low (PCA9665) */
33262306a36Sopenharmony_ci		case 0x90: /* Bus error - SCL stuck low (PCA9564) */
33362306a36Sopenharmony_ci			DEB2("BUS ERROR - SCL Stuck low\n");
33462306a36Sopenharmony_ci			pca_reset(adap);
33562306a36Sopenharmony_ci			goto out;
33662306a36Sopenharmony_ci		case 0x00: /* Bus error during master or slave mode due to illegal START or STOP condition */
33762306a36Sopenharmony_ci			DEB2("BUS ERROR - Illegal START or STOP\n");
33862306a36Sopenharmony_ci			pca_reset(adap);
33962306a36Sopenharmony_ci			goto out;
34062306a36Sopenharmony_ci		default:
34162306a36Sopenharmony_ci			dev_err(&i2c_adap->dev, "unhandled SIO state 0x%02x\n", state);
34262306a36Sopenharmony_ci			break;
34362306a36Sopenharmony_ci		}
34462306a36Sopenharmony_ci
34562306a36Sopenharmony_ci		if (!completed)
34662306a36Sopenharmony_ci			goto out;
34762306a36Sopenharmony_ci	}
34862306a36Sopenharmony_ci
34962306a36Sopenharmony_ci	ret = curmsg;
35062306a36Sopenharmony_ci out:
35162306a36Sopenharmony_ci	DEB1("}}} transferred %d/%d messages. "
35262306a36Sopenharmony_ci	     "status is %#04x. control is %#04x\n",
35362306a36Sopenharmony_ci	     curmsg, num, pca_status(adap),
35462306a36Sopenharmony_ci	     pca_get_con(adap));
35562306a36Sopenharmony_ci	return ret;
35662306a36Sopenharmony_ci}
35762306a36Sopenharmony_ci
35862306a36Sopenharmony_cistatic u32 pca_func(struct i2c_adapter *adap)
35962306a36Sopenharmony_ci{
36062306a36Sopenharmony_ci	return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL;
36162306a36Sopenharmony_ci}
36262306a36Sopenharmony_ci
36362306a36Sopenharmony_cistatic const struct i2c_algorithm pca_algo = {
36462306a36Sopenharmony_ci	.master_xfer	= pca_xfer,
36562306a36Sopenharmony_ci	.functionality	= pca_func,
36662306a36Sopenharmony_ci};
36762306a36Sopenharmony_ci
36862306a36Sopenharmony_cistatic unsigned int pca_probe_chip(struct i2c_adapter *adap)
36962306a36Sopenharmony_ci{
37062306a36Sopenharmony_ci	struct i2c_algo_pca_data *pca_data = adap->algo_data;
37162306a36Sopenharmony_ci	/* The trick here is to check if there is an indirect register
37262306a36Sopenharmony_ci	 * available. If there is one, we will read the value we first
37362306a36Sopenharmony_ci	 * wrote on I2C_PCA_IADR. Otherwise, we will read the last value
37462306a36Sopenharmony_ci	 * we wrote on I2C_PCA_ADR
37562306a36Sopenharmony_ci	 */
37662306a36Sopenharmony_ci	pca_outw(pca_data, I2C_PCA_INDPTR, I2C_PCA_IADR);
37762306a36Sopenharmony_ci	pca_outw(pca_data, I2C_PCA_IND, 0xAA);
37862306a36Sopenharmony_ci	pca_outw(pca_data, I2C_PCA_INDPTR, I2C_PCA_ITO);
37962306a36Sopenharmony_ci	pca_outw(pca_data, I2C_PCA_IND, 0x00);
38062306a36Sopenharmony_ci	pca_outw(pca_data, I2C_PCA_INDPTR, I2C_PCA_IADR);
38162306a36Sopenharmony_ci	if (pca_inw(pca_data, I2C_PCA_IND) == 0xAA) {
38262306a36Sopenharmony_ci		printk(KERN_INFO "%s: PCA9665 detected.\n", adap->name);
38362306a36Sopenharmony_ci		pca_data->chip = I2C_PCA_CHIP_9665;
38462306a36Sopenharmony_ci	} else {
38562306a36Sopenharmony_ci		printk(KERN_INFO "%s: PCA9564 detected.\n", adap->name);
38662306a36Sopenharmony_ci		pca_data->chip = I2C_PCA_CHIP_9564;
38762306a36Sopenharmony_ci	}
38862306a36Sopenharmony_ci	return pca_data->chip;
38962306a36Sopenharmony_ci}
39062306a36Sopenharmony_ci
39162306a36Sopenharmony_cistatic int pca_init(struct i2c_adapter *adap)
39262306a36Sopenharmony_ci{
39362306a36Sopenharmony_ci	struct i2c_algo_pca_data *pca_data = adap->algo_data;
39462306a36Sopenharmony_ci
39562306a36Sopenharmony_ci	adap->algo = &pca_algo;
39662306a36Sopenharmony_ci
39762306a36Sopenharmony_ci	if (pca_probe_chip(adap) == I2C_PCA_CHIP_9564) {
39862306a36Sopenharmony_ci		static int freqs[] = {330, 288, 217, 146, 88, 59, 44, 36};
39962306a36Sopenharmony_ci		int clock;
40062306a36Sopenharmony_ci
40162306a36Sopenharmony_ci		if (pca_data->i2c_clock > 7) {
40262306a36Sopenharmony_ci			switch (pca_data->i2c_clock) {
40362306a36Sopenharmony_ci			case 330000:
40462306a36Sopenharmony_ci				pca_data->i2c_clock = I2C_PCA_CON_330kHz;
40562306a36Sopenharmony_ci				break;
40662306a36Sopenharmony_ci			case 288000:
40762306a36Sopenharmony_ci				pca_data->i2c_clock = I2C_PCA_CON_288kHz;
40862306a36Sopenharmony_ci				break;
40962306a36Sopenharmony_ci			case 217000:
41062306a36Sopenharmony_ci				pca_data->i2c_clock = I2C_PCA_CON_217kHz;
41162306a36Sopenharmony_ci				break;
41262306a36Sopenharmony_ci			case 146000:
41362306a36Sopenharmony_ci				pca_data->i2c_clock = I2C_PCA_CON_146kHz;
41462306a36Sopenharmony_ci				break;
41562306a36Sopenharmony_ci			case 88000:
41662306a36Sopenharmony_ci				pca_data->i2c_clock = I2C_PCA_CON_88kHz;
41762306a36Sopenharmony_ci				break;
41862306a36Sopenharmony_ci			case 59000:
41962306a36Sopenharmony_ci				pca_data->i2c_clock = I2C_PCA_CON_59kHz;
42062306a36Sopenharmony_ci				break;
42162306a36Sopenharmony_ci			case 44000:
42262306a36Sopenharmony_ci				pca_data->i2c_clock = I2C_PCA_CON_44kHz;
42362306a36Sopenharmony_ci				break;
42462306a36Sopenharmony_ci			case 36000:
42562306a36Sopenharmony_ci				pca_data->i2c_clock = I2C_PCA_CON_36kHz;
42662306a36Sopenharmony_ci				break;
42762306a36Sopenharmony_ci			default:
42862306a36Sopenharmony_ci				printk(KERN_WARNING
42962306a36Sopenharmony_ci					"%s: Invalid I2C clock speed selected."
43062306a36Sopenharmony_ci					" Using default 59kHz.\n", adap->name);
43162306a36Sopenharmony_ci			pca_data->i2c_clock = I2C_PCA_CON_59kHz;
43262306a36Sopenharmony_ci			}
43362306a36Sopenharmony_ci		} else {
43462306a36Sopenharmony_ci			printk(KERN_WARNING "%s: "
43562306a36Sopenharmony_ci				"Choosing the clock frequency based on "
43662306a36Sopenharmony_ci				"index is deprecated."
43762306a36Sopenharmony_ci				" Use the nominal frequency.\n", adap->name);
43862306a36Sopenharmony_ci		}
43962306a36Sopenharmony_ci
44062306a36Sopenharmony_ci		clock = pca_clock(pca_data);
44162306a36Sopenharmony_ci		printk(KERN_INFO "%s: Clock frequency is %dkHz\n",
44262306a36Sopenharmony_ci		     adap->name, freqs[clock]);
44362306a36Sopenharmony_ci
44462306a36Sopenharmony_ci		/* Store settings as these will be needed when the PCA chip is reset */
44562306a36Sopenharmony_ci		pca_data->bus_settings.clock_freq = clock;
44662306a36Sopenharmony_ci
44762306a36Sopenharmony_ci		pca_reset(pca_data);
44862306a36Sopenharmony_ci	} else {
44962306a36Sopenharmony_ci		int clock;
45062306a36Sopenharmony_ci		int mode;
45162306a36Sopenharmony_ci		int tlow, thi;
45262306a36Sopenharmony_ci		/* Values can be found on PCA9665 datasheet section 7.3.2.6 */
45362306a36Sopenharmony_ci		int min_tlow, min_thi;
45462306a36Sopenharmony_ci		/* These values are the maximum raise and fall values allowed
45562306a36Sopenharmony_ci		 * by the I2C operation mode (Standard, Fast or Fast+)
45662306a36Sopenharmony_ci		 * They are used (added) below to calculate the clock dividers
45762306a36Sopenharmony_ci		 * of PCA9665. Note that they are slightly different of the
45862306a36Sopenharmony_ci		 * real maximum, to allow the change on mode exactly on the
45962306a36Sopenharmony_ci		 * maximum clock rate for each mode
46062306a36Sopenharmony_ci		 */
46162306a36Sopenharmony_ci		int raise_fall_time;
46262306a36Sopenharmony_ci
46362306a36Sopenharmony_ci		if (pca_data->i2c_clock > 1265800) {
46462306a36Sopenharmony_ci			printk(KERN_WARNING "%s: I2C clock speed too high."
46562306a36Sopenharmony_ci				" Using 1265.8kHz.\n", adap->name);
46662306a36Sopenharmony_ci			pca_data->i2c_clock = 1265800;
46762306a36Sopenharmony_ci		}
46862306a36Sopenharmony_ci
46962306a36Sopenharmony_ci		if (pca_data->i2c_clock < 60300) {
47062306a36Sopenharmony_ci			printk(KERN_WARNING "%s: I2C clock speed too low."
47162306a36Sopenharmony_ci				" Using 60.3kHz.\n", adap->name);
47262306a36Sopenharmony_ci			pca_data->i2c_clock = 60300;
47362306a36Sopenharmony_ci		}
47462306a36Sopenharmony_ci
47562306a36Sopenharmony_ci		/* To avoid integer overflow, use clock/100 for calculations */
47662306a36Sopenharmony_ci		clock = pca_clock(pca_data) / 100;
47762306a36Sopenharmony_ci
47862306a36Sopenharmony_ci		if (pca_data->i2c_clock > I2C_MAX_FAST_MODE_PLUS_FREQ) {
47962306a36Sopenharmony_ci			mode = I2C_PCA_MODE_TURBO;
48062306a36Sopenharmony_ci			min_tlow = 14;
48162306a36Sopenharmony_ci			min_thi  = 5;
48262306a36Sopenharmony_ci			raise_fall_time = 22; /* Raise 11e-8s, Fall 11e-8s */
48362306a36Sopenharmony_ci		} else if (pca_data->i2c_clock > I2C_MAX_FAST_MODE_FREQ) {
48462306a36Sopenharmony_ci			mode = I2C_PCA_MODE_FASTP;
48562306a36Sopenharmony_ci			min_tlow = 17;
48662306a36Sopenharmony_ci			min_thi  = 9;
48762306a36Sopenharmony_ci			raise_fall_time = 22; /* Raise 11e-8s, Fall 11e-8s */
48862306a36Sopenharmony_ci		} else if (pca_data->i2c_clock > I2C_MAX_STANDARD_MODE_FREQ) {
48962306a36Sopenharmony_ci			mode = I2C_PCA_MODE_FAST;
49062306a36Sopenharmony_ci			min_tlow = 44;
49162306a36Sopenharmony_ci			min_thi  = 20;
49262306a36Sopenharmony_ci			raise_fall_time = 58; /* Raise 29e-8s, Fall 29e-8s */
49362306a36Sopenharmony_ci		} else {
49462306a36Sopenharmony_ci			mode = I2C_PCA_MODE_STD;
49562306a36Sopenharmony_ci			min_tlow = 157;
49662306a36Sopenharmony_ci			min_thi  = 134;
49762306a36Sopenharmony_ci			raise_fall_time = 127; /* Raise 29e-8s, Fall 98e-8s */
49862306a36Sopenharmony_ci		}
49962306a36Sopenharmony_ci
50062306a36Sopenharmony_ci		/* The minimum clock that respects the thi/tlow = 134/157 is
50162306a36Sopenharmony_ci		 * 64800 Hz. Below that, we have to fix the tlow to 255 and
50262306a36Sopenharmony_ci		 * calculate the thi factor.
50362306a36Sopenharmony_ci		 */
50462306a36Sopenharmony_ci		if (clock < 648) {
50562306a36Sopenharmony_ci			tlow = 255;
50662306a36Sopenharmony_ci			thi = 1000000 - clock * raise_fall_time;
50762306a36Sopenharmony_ci			thi /= (I2C_PCA_OSC_PER * clock) - tlow;
50862306a36Sopenharmony_ci		} else {
50962306a36Sopenharmony_ci			tlow = (1000000 - clock * raise_fall_time) * min_tlow;
51062306a36Sopenharmony_ci			tlow /= I2C_PCA_OSC_PER * clock * (min_thi + min_tlow);
51162306a36Sopenharmony_ci			thi = tlow * min_thi / min_tlow;
51262306a36Sopenharmony_ci		}
51362306a36Sopenharmony_ci
51462306a36Sopenharmony_ci		/* Store settings as these will be needed when the PCA chip is reset */
51562306a36Sopenharmony_ci		pca_data->bus_settings.mode = mode;
51662306a36Sopenharmony_ci		pca_data->bus_settings.tlow = tlow;
51762306a36Sopenharmony_ci		pca_data->bus_settings.thi = thi;
51862306a36Sopenharmony_ci
51962306a36Sopenharmony_ci		pca_reset(pca_data);
52062306a36Sopenharmony_ci
52162306a36Sopenharmony_ci		printk(KERN_INFO
52262306a36Sopenharmony_ci		     "%s: Clock frequency is %dHz\n", adap->name, clock * 100);
52362306a36Sopenharmony_ci	}
52462306a36Sopenharmony_ci	udelay(500); /* 500 us for oscillator to stabilise */
52562306a36Sopenharmony_ci
52662306a36Sopenharmony_ci	return 0;
52762306a36Sopenharmony_ci}
52862306a36Sopenharmony_ci
52962306a36Sopenharmony_ci/*
53062306a36Sopenharmony_ci * registering functions to load algorithms at runtime
53162306a36Sopenharmony_ci */
53262306a36Sopenharmony_ciint i2c_pca_add_bus(struct i2c_adapter *adap)
53362306a36Sopenharmony_ci{
53462306a36Sopenharmony_ci	int rval;
53562306a36Sopenharmony_ci
53662306a36Sopenharmony_ci	rval = pca_init(adap);
53762306a36Sopenharmony_ci	if (rval)
53862306a36Sopenharmony_ci		return rval;
53962306a36Sopenharmony_ci
54062306a36Sopenharmony_ci	return i2c_add_adapter(adap);
54162306a36Sopenharmony_ci}
54262306a36Sopenharmony_ciEXPORT_SYMBOL(i2c_pca_add_bus);
54362306a36Sopenharmony_ci
54462306a36Sopenharmony_ciint i2c_pca_add_numbered_bus(struct i2c_adapter *adap)
54562306a36Sopenharmony_ci{
54662306a36Sopenharmony_ci	int rval;
54762306a36Sopenharmony_ci
54862306a36Sopenharmony_ci	rval = pca_init(adap);
54962306a36Sopenharmony_ci	if (rval)
55062306a36Sopenharmony_ci		return rval;
55162306a36Sopenharmony_ci
55262306a36Sopenharmony_ci	return i2c_add_numbered_adapter(adap);
55362306a36Sopenharmony_ci}
55462306a36Sopenharmony_ciEXPORT_SYMBOL(i2c_pca_add_numbered_bus);
55562306a36Sopenharmony_ci
55662306a36Sopenharmony_ciMODULE_AUTHOR("Ian Campbell <icampbell@arcom.com>");
55762306a36Sopenharmony_ciMODULE_AUTHOR("Wolfram Sang <kernel@pengutronix.de>");
55862306a36Sopenharmony_ciMODULE_DESCRIPTION("I2C-Bus PCA9564/PCA9665 algorithm");
55962306a36Sopenharmony_ciMODULE_LICENSE("GPL");
56062306a36Sopenharmony_ci
56162306a36Sopenharmony_cimodule_param(i2c_debug, int, 0);
562