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