Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) // SPDX-License-Identifier: GPL-2.0-or-later
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)  *  Driver for the Conexant CX23885 PCIe bridge
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  *  Copyright (c) 2006 Steven Toth <stoth@linuxtv.org>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8) #include "cx23885.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11) #include <linux/init.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12) #include <linux/delay.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13) #include <asm/io.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) #include <media/v4l2-common.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) static unsigned int i2c_debug;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) module_param(i2c_debug, int, 0644);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) MODULE_PARM_DESC(i2c_debug, "enable debug messages [i2c]");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) static unsigned int i2c_scan;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) module_param(i2c_scan, int, 0444);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) MODULE_PARM_DESC(i2c_scan, "scan i2c bus at insmod time");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) #define dprintk(level, fmt, arg...)\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) 	do { if (i2c_debug >= level)\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) 		printk(KERN_DEBUG pr_fmt("%s: i2c:" fmt), \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) 			__func__, ##arg); \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) 	} while (0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) #define I2C_WAIT_DELAY 32
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) #define I2C_WAIT_RETRY 64
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) #define I2C_EXTEND  (1 << 3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) #define I2C_NOSTOP  (1 << 4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) static inline int i2c_slave_did_ack(struct i2c_adapter *i2c_adap)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) 	struct cx23885_i2c *bus = i2c_adap->algo_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) 	struct cx23885_dev *dev = bus->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) 	return cx_read(bus->reg_stat) & 0x01;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) static inline int i2c_is_busy(struct i2c_adapter *i2c_adap)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) 	struct cx23885_i2c *bus = i2c_adap->algo_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) 	struct cx23885_dev *dev = bus->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) 	return cx_read(bus->reg_stat) & 0x02 ? 1 : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) static int i2c_wait_done(struct i2c_adapter *i2c_adap)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) 	int count;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) 	for (count = 0; count < I2C_WAIT_RETRY; count++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) 		if (!i2c_is_busy(i2c_adap))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) 		udelay(I2C_WAIT_DELAY);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) 	if (I2C_WAIT_RETRY == count)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) 	return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) static int i2c_sendbytes(struct i2c_adapter *i2c_adap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 			 const struct i2c_msg *msg, int joined_rlen)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 	struct cx23885_i2c *bus = i2c_adap->algo_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) 	struct cx23885_dev *dev = bus->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 	u32 wdata, addr, ctrl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 	int retval, cnt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) 	if (joined_rlen)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 		dprintk(1, "%s(msg->wlen=%d, nextmsg->rlen=%d)\n", __func__,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 			msg->len, joined_rlen);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) 	else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) 		dprintk(1, "%s(msg->len=%d)\n", __func__, msg->len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 	/* Deal with i2c probe functions with zero payload */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) 	if (msg->len == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) 		cx_write(bus->reg_addr, msg->addr << 25);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 		cx_write(bus->reg_ctrl, bus->i2c_period | (1 << 2));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 		if (!i2c_wait_done(i2c_adap))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 			return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 		if (!i2c_slave_did_ack(i2c_adap))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 			return -ENXIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 		dprintk(1, "%s() returns 0\n", __func__);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 	/* dev, reg + first byte */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 	addr = (msg->addr << 25) | msg->buf[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 	wdata = msg->buf[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 	ctrl = bus->i2c_period | (1 << 12) | (1 << 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 	if (msg->len > 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) 		ctrl |= I2C_NOSTOP | I2C_EXTEND;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) 	else if (joined_rlen)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 		ctrl |= I2C_NOSTOP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 	cx_write(bus->reg_addr, addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) 	cx_write(bus->reg_wdata, wdata);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) 	cx_write(bus->reg_ctrl, ctrl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 	if (!i2c_wait_done(i2c_adap))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 		goto eio;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 	if (i2c_debug) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 		printk(KERN_DEBUG " <W %02x %02x", msg->addr << 1, msg->buf[0]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 		if (!(ctrl & I2C_NOSTOP))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 			pr_cont(" >\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) 	for (cnt = 1; cnt < msg->len; cnt++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) 		/* following bytes */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) 		wdata = msg->buf[cnt];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) 		ctrl = bus->i2c_period | (1 << 12) | (1 << 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) 		if (cnt < msg->len - 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) 			ctrl |= I2C_NOSTOP | I2C_EXTEND;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 		else if (joined_rlen)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) 			ctrl |= I2C_NOSTOP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 		cx_write(bus->reg_addr, addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) 		cx_write(bus->reg_wdata, wdata);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 		cx_write(bus->reg_ctrl, ctrl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) 		if (!i2c_wait_done(i2c_adap))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 			goto eio;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 		if (i2c_debug) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 			pr_cont(" %02x", msg->buf[cnt]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) 			if (!(ctrl & I2C_NOSTOP))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) 				pr_cont(" >\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) 	return msg->len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141)  eio:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) 	retval = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) 	if (i2c_debug)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) 		pr_err(" ERR: %d\n", retval);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) 	return retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) static int i2c_readbytes(struct i2c_adapter *i2c_adap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) 			 const struct i2c_msg *msg, int joined)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 	struct cx23885_i2c *bus = i2c_adap->algo_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) 	struct cx23885_dev *dev = bus->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) 	u32 ctrl, cnt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 	int retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) 	if (i2c_debug && !joined)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) 		dprintk(1, "%s(msg->len=%d)\n", __func__, msg->len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 	/* Deal with i2c probe functions with zero payload */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) 	if (msg->len == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) 		cx_write(bus->reg_addr, msg->addr << 25);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) 		cx_write(bus->reg_ctrl, bus->i2c_period | (1 << 2) | 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) 		if (!i2c_wait_done(i2c_adap))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) 			return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) 		if (!i2c_slave_did_ack(i2c_adap))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) 			return -ENXIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) 		dprintk(1, "%s() returns 0\n", __func__);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) 	if (i2c_debug) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) 		if (joined)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) 			dprintk(1, " R");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) 		else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) 			dprintk(1, " <R %02x", (msg->addr << 1) + 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) 	for (cnt = 0; cnt < msg->len; cnt++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) 		ctrl = bus->i2c_period | (1 << 12) | (1 << 2) | 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) 		if (cnt < msg->len - 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) 			ctrl |= I2C_NOSTOP | I2C_EXTEND;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) 		cx_write(bus->reg_addr, msg->addr << 25);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) 		cx_write(bus->reg_ctrl, ctrl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) 		if (!i2c_wait_done(i2c_adap))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) 			goto eio;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) 		msg->buf[cnt] = cx_read(bus->reg_rdata) & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) 		if (i2c_debug) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) 			dprintk(1, " %02x", msg->buf[cnt]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) 			if (!(ctrl & I2C_NOSTOP))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) 				dprintk(1, " >\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) 	return msg->len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202)  eio:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) 	retval = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) 	if (i2c_debug)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) 		pr_err(" ERR: %d\n", retval);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) 	return retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) static int i2c_xfer(struct i2c_adapter *i2c_adap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) 		    struct i2c_msg *msgs, int num)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) 	int i, retval = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) 	dprintk(1, "%s(num = %d)\n", __func__, num);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) 	for (i = 0 ; i < num; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) 		dprintk(1, "%s(num = %d) addr = 0x%02x  len = 0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) 			__func__, num, msgs[i].addr, msgs[i].len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) 		if (msgs[i].flags & I2C_M_RD) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) 			/* read */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) 			retval = i2c_readbytes(i2c_adap, &msgs[i], 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) 		} else if (i + 1 < num && (msgs[i + 1].flags & I2C_M_RD) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) 			   msgs[i].addr == msgs[i + 1].addr) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) 			/* write then read from same address */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) 			retval = i2c_sendbytes(i2c_adap, &msgs[i],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) 					       msgs[i + 1].len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) 			if (retval < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) 				goto err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) 			i++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) 			retval = i2c_readbytes(i2c_adap, &msgs[i], 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) 		} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) 			/* write */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) 			retval = i2c_sendbytes(i2c_adap, &msgs[i], 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) 		if (retval < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) 			goto err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) 	return num;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240)  err:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) 	return retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) static u32 cx23885_functionality(struct i2c_adapter *adap)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) 	return I2C_FUNC_SMBUS_EMUL | I2C_FUNC_I2C;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) static const struct i2c_algorithm cx23885_i2c_algo_template = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) 	.master_xfer	= i2c_xfer,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) 	.functionality	= cx23885_functionality,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) /* ----------------------------------------------------------------------- */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) static const struct i2c_adapter cx23885_i2c_adap_template = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) 	.name              = "cx23885",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) 	.owner             = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) 	.algo              = &cx23885_i2c_algo_template,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) static const struct i2c_client cx23885_i2c_client_template = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) 	.name	= "cx23885 internal",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) static char *i2c_devs[128] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) 	[0x10 >> 1] = "tda10048",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) 	[0x12 >> 1] = "dib7000pc",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) 	[0x1c >> 1] = "lgdt3303",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) 	[0x80 >> 1] = "cs3308",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) 	[0x82 >> 1] = "cs3308",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) 	[0x86 >> 1] = "tda9887",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) 	[0x32 >> 1] = "cx24227",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) 	[0x88 >> 1] = "cx25837",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) 	[0x84 >> 1] = "tda8295",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) 	[0x98 >> 1] = "flatiron",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) 	[0xa0 >> 1] = "eeprom",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) 	[0xc0 >> 1] = "tuner/mt2131/tda8275",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) 	[0xc2 >> 1] = "tuner/mt2131/tda8275/xc5000/xc3028",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) 	[0xc8 >> 1] = "tuner/xc3028L",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) static void do_i2c_scan(char *name, struct i2c_client *c)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) 	unsigned char buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) 	int i, rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) 	for (i = 0; i < 128; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) 		c->addr = i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) 		rc = i2c_master_recv(c, &buf, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) 		if (rc < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) 			continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) 		pr_info("%s: i2c scan: found device @ 0x%04x  [%s]\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) 		       name, i, i2c_devs[i] ? i2c_devs[i] : "???");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) /* init + register i2c adapter */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) int cx23885_i2c_register(struct cx23885_i2c *bus)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) 	struct cx23885_dev *dev = bus->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) 	dprintk(1, "%s(bus = %d)\n", __func__, bus->nr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) 	bus->i2c_adap = cx23885_i2c_adap_template;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) 	bus->i2c_client = cx23885_i2c_client_template;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) 	bus->i2c_adap.dev.parent = &dev->pci->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) 	strscpy(bus->i2c_adap.name, bus->dev->name,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) 		sizeof(bus->i2c_adap.name));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) 	bus->i2c_adap.algo_data = bus;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) 	i2c_set_adapdata(&bus->i2c_adap, &dev->v4l2_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) 	i2c_add_adapter(&bus->i2c_adap);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) 	bus->i2c_client.adapter = &bus->i2c_adap;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) 	if (0 == bus->i2c_rc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) 		dprintk(1, "%s: i2c bus %d registered\n", dev->name, bus->nr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) 		if (i2c_scan) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) 			pr_info("%s: scan bus %d:\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) 					dev->name, bus->nr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) 			do_i2c_scan(dev->name, &bus->i2c_client);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) 	} else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) 		pr_warn("%s: i2c bus %d register FAILED\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) 			dev->name, bus->nr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) 	/* Instantiate the IR receiver device, if present */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) 	if (0 == bus->i2c_rc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) 		struct i2c_board_info info;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) 		static const unsigned short addr_list[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) 			0x6b, I2C_CLIENT_END
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) 		};
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) 		memset(&info, 0, sizeof(struct i2c_board_info));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) 		strscpy(info.type, "ir_video", I2C_NAME_SIZE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) 		/* Use quick read command for probe, some IR chips don't
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) 		 * support writes */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) 		i2c_new_scanned_device(&bus->i2c_adap, &info, addr_list,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) 				       i2c_probe_func_quick_read);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) 	return bus->i2c_rc;
^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) int cx23885_i2c_unregister(struct cx23885_i2c *bus)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) 	i2c_del_adapter(&bus->i2c_adap);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) void cx23885_av_clk(struct cx23885_dev *dev, int enable)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) 	/* write 0 to bus 2 addr 0x144 via i2x_xfer() */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) 	char buffer[3];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) 	struct i2c_msg msg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) 	dprintk(1, "%s(enabled = %d)\n", __func__, enable);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) 	/* Register 0x144 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) 	buffer[0] = 0x01;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) 	buffer[1] = 0x44;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) 	if (enable == 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) 		buffer[2] = 0x05;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) 	else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) 		buffer[2] = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) 	msg.addr = 0x44;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) 	msg.flags = I2C_M_TEN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) 	msg.len = 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) 	msg.buf = buffer;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) 	i2c_xfer(&dev->i2c_bus[2].i2c_adap, &msg, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) }