Blame view

drivers/media/video/cx23885/cx23885-i2c.c 10.7 KB
d19770e51   Steven Toth   V4L/DVB (6150): A...
1
2
3
  /*
   *  Driver for the Conexant CX23885 PCIe bridge
   *
6d8976164   Steven Toth   V4L/DVB (8805): S...
4
   *  Copyright (c) 2006 Steven Toth <stoth@linuxtv.org>
d19770e51   Steven Toth   V4L/DVB (6150): A...
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
   *
   *  This program is free software; you can redistribute it and/or modify
   *  it under the terms of the GNU General Public License as published by
   *  the Free Software Foundation; either version 2 of the License, or
   *  (at your option) any later version.
   *
   *  This program is distributed in the hope that it will be useful,
   *  but WITHOUT ANY WARRANTY; without even the implied warranty of
   *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
   *
   *  GNU General Public License for more details.
   *
   *  You should have received a copy of the GNU General Public License
   *  along with this program; if not, write to the Free Software
   *  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
   */
  
  #include <linux/module.h>
  #include <linux/moduleparam.h>
  #include <linux/init.h>
  #include <linux/delay.h>
  #include <asm/io.h>
  
  #include "cx23885.h"
  
  #include <media/v4l2-common.h>
4513fc696   Steven Toth   V4L/DVB (7014): c...
31
  static unsigned int i2c_debug;
d19770e51   Steven Toth   V4L/DVB (6150): A...
32
  module_param(i2c_debug, int, 0644);
44a6481dc   Michael Krufky   V4L/DVB (6162): c...
33
  MODULE_PARM_DESC(i2c_debug, "enable debug messages [i2c]");
d19770e51   Steven Toth   V4L/DVB (6150): A...
34

ff699e6bd   Douglas Schilling Landgraf   V4L/DVB (7094): ...
35
  static unsigned int i2c_scan;
d19770e51   Steven Toth   V4L/DVB (6150): A...
36
  module_param(i2c_scan, int, 0444);
44a6481dc   Michael Krufky   V4L/DVB (6162): c...
37
  MODULE_PARM_DESC(i2c_scan, "scan i2c bus at insmod time");
d19770e51   Steven Toth   V4L/DVB (6150): A...
38

4513fc696   Steven Toth   V4L/DVB (7014): c...
39
40
41
  #define dprintk(level, fmt, arg...)\
  	do { if (i2c_debug >= level)\
  		printk(KERN_DEBUG "%s/0: " fmt, dev->name, ## arg);\
5e3c5967d   Chris Pascoe   V4L/DVB (6857): c...
42
  	} while (0)
d19770e51   Steven Toth   V4L/DVB (6150): A...
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
  
  #define I2C_WAIT_DELAY 32
  #define I2C_WAIT_RETRY 64
  
  #define I2C_EXTEND  (1 << 3)
  #define I2C_NOSTOP  (1 << 4)
  
  static inline int i2c_slave_did_ack(struct i2c_adapter *i2c_adap)
  {
  	struct cx23885_i2c *bus = i2c_adap->algo_data;
  	struct cx23885_dev *dev = bus->dev;
  	return cx_read(bus->reg_stat) & 0x01;
  }
  
  static inline int i2c_is_busy(struct i2c_adapter *i2c_adap)
  {
  	struct cx23885_i2c *bus = i2c_adap->algo_data;
  	struct cx23885_dev *dev = bus->dev;
  	return cx_read(bus->reg_stat) & 0x02 ? 1 : 0;
  }
  
  static int i2c_wait_done(struct i2c_adapter *i2c_adap)
  {
  	int count;
  
  	for (count = 0; count < I2C_WAIT_RETRY; count++) {
  		if (!i2c_is_busy(i2c_adap))
  			break;
  		udelay(I2C_WAIT_DELAY);
  	}
  
  	if (I2C_WAIT_RETRY == count)
  		return 0;
  
  	return 1;
  }
44a6481dc   Michael Krufky   V4L/DVB (6162): c...
79
  static int i2c_sendbytes(struct i2c_adapter *i2c_adap,
5e3c5967d   Chris Pascoe   V4L/DVB (6857): c...
80
  			 const struct i2c_msg *msg, int joined_rlen)
d19770e51   Steven Toth   V4L/DVB (6150): A...
81
82
83
84
85
  {
  	struct cx23885_i2c *bus = i2c_adap->algo_data;
  	struct cx23885_dev *dev = bus->dev;
  	u32 wdata, addr, ctrl;
  	int retval, cnt;
5e3c5967d   Chris Pascoe   V4L/DVB (6857): c...
86
  	if (joined_rlen)
22b4e64f0   Harvey Harrison   V4L/DVB (7520): m...
87
88
  		dprintk(1, "%s(msg->wlen=%d, nextmsg->rlen=%d)
  ", __func__,
5e3c5967d   Chris Pascoe   V4L/DVB (6857): c...
89
90
  			msg->len, joined_rlen);
  	else
22b4e64f0   Harvey Harrison   V4L/DVB (7520): m...
91
92
  		dprintk(1, "%s(msg->len=%d)
  ", __func__, msg->len);
e92adc2c3   Steven Toth   V4L/DVB (6404): c...
93

d19770e51   Steven Toth   V4L/DVB (6150): A...
94
95
96
97
98
99
100
101
  	/* Deal with i2c probe functions with zero payload */
  	if (msg->len == 0) {
  		cx_write(bus->reg_addr, msg->addr << 25);
  		cx_write(bus->reg_ctrl, bus->i2c_period | (1 << 2));
  		if (!i2c_wait_done(i2c_adap))
  			return -EIO;
  		if (!i2c_slave_did_ack(i2c_adap))
  			return -EIO;
22b4e64f0   Harvey Harrison   V4L/DVB (7520): m...
102
103
  		dprintk(1, "%s() returns 0
  ", __func__);
d19770e51   Steven Toth   V4L/DVB (6150): A...
104
105
106
107
108
109
110
111
112
113
114
  		return 0;
  	}
  
  
  	/* dev, reg + first byte */
  	addr = (msg->addr << 25) | msg->buf[0];
  	wdata = msg->buf[0];
  	ctrl = bus->i2c_period | (1 << 12) | (1 << 2);
  
  	if (msg->len > 1)
  		ctrl |= I2C_NOSTOP | I2C_EXTEND;
5e3c5967d   Chris Pascoe   V4L/DVB (6857): c...
115
116
  	else if (joined_rlen)
  		ctrl |= I2C_NOSTOP;
d19770e51   Steven Toth   V4L/DVB (6150): A...
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
  
  	cx_write(bus->reg_addr, addr);
  	cx_write(bus->reg_wdata, wdata);
  	cx_write(bus->reg_ctrl, ctrl);
  
  	retval = i2c_wait_done(i2c_adap);
  	if (retval < 0)
  		goto err;
  	if (retval == 0)
  		goto eio;
  	if (i2c_debug) {
  		printk(" <W %02x %02x", msg->addr << 1, msg->buf[0]);
  		if (!(ctrl & I2C_NOSTOP))
  			printk(" >
  ");
  	}
9c8ced511   Steven Toth   V4L/DVB (9251): c...
133
  	for (cnt = 1; cnt < msg->len; cnt++) {
d19770e51   Steven Toth   V4L/DVB (6150): A...
134
135
136
  		/* following bytes */
  		wdata = msg->buf[cnt];
  		ctrl = bus->i2c_period | (1 << 12) | (1 << 2);
e92adc2c3   Steven Toth   V4L/DVB (6404): c...
137
  		if (cnt < msg->len - 1)
d19770e51   Steven Toth   V4L/DVB (6150): A...
138
  			ctrl |= I2C_NOSTOP | I2C_EXTEND;
5e3c5967d   Chris Pascoe   V4L/DVB (6857): c...
139
140
  		else if (joined_rlen)
  			ctrl |= I2C_NOSTOP;
d19770e51   Steven Toth   V4L/DVB (6150): A...
141

d19770e51   Steven Toth   V4L/DVB (6150): A...
142
143
144
145
146
147
148
149
150
151
  		cx_write(bus->reg_addr, addr);
  		cx_write(bus->reg_wdata, wdata);
  		cx_write(bus->reg_ctrl, ctrl);
  
  		retval = i2c_wait_done(i2c_adap);
  		if (retval < 0)
  			goto err;
  		if (retval == 0)
  			goto eio;
  		if (i2c_debug) {
9c8ced511   Steven Toth   V4L/DVB (9251): c...
152
  			dprintk(1, " %02x", msg->buf[cnt]);
d19770e51   Steven Toth   V4L/DVB (6150): A...
153
  			if (!(ctrl & I2C_NOSTOP))
9c8ced511   Steven Toth   V4L/DVB (9251): c...
154
155
  				dprintk(1, " >
  ");
d19770e51   Steven Toth   V4L/DVB (6150): A...
156
157
158
159
160
161
162
  		}
  	}
  	return msg->len;
  
   eio:
  	retval = -EIO;
   err:
5e3c5967d   Chris Pascoe   V4L/DVB (6857): c...
163
  	if (i2c_debug)
9c8ced511   Steven Toth   V4L/DVB (9251): c...
164
165
  		printk(KERN_ERR " ERR: %d
  ", retval);
d19770e51   Steven Toth   V4L/DVB (6150): A...
166
167
  	return retval;
  }
44a6481dc   Michael Krufky   V4L/DVB (6162): c...
168
  static int i2c_readbytes(struct i2c_adapter *i2c_adap,
5e3c5967d   Chris Pascoe   V4L/DVB (6857): c...
169
  			 const struct i2c_msg *msg, int joined)
d19770e51   Steven Toth   V4L/DVB (6150): A...
170
171
172
173
174
  {
  	struct cx23885_i2c *bus = i2c_adap->algo_data;
  	struct cx23885_dev *dev = bus->dev;
  	u32 ctrl, cnt;
  	int retval;
5e3c5967d   Chris Pascoe   V4L/DVB (6857): c...
175
176
  
  	if (i2c_debug && !joined)
22b4e64f0   Harvey Harrison   V4L/DVB (7520): m...
177
178
  		dprintk(1, "%s(msg->len=%d)
  ", __func__, msg->len);
d19770e51   Steven Toth   V4L/DVB (6150): A...
179
180
181
182
183
184
185
186
187
  
  	/* Deal with i2c probe functions with zero payload */
  	if (msg->len == 0) {
  		cx_write(bus->reg_addr, msg->addr << 25);
  		cx_write(bus->reg_ctrl, bus->i2c_period | (1 << 2) | 1);
  		if (!i2c_wait_done(i2c_adap))
  			return -EIO;
  		if (!i2c_slave_did_ack(i2c_adap))
  			return -EIO;
22b4e64f0   Harvey Harrison   V4L/DVB (7520): m...
188
189
  		dprintk(1, "%s() returns 0
  ", __func__);
d19770e51   Steven Toth   V4L/DVB (6150): A...
190
191
  		return 0;
  	}
5e3c5967d   Chris Pascoe   V4L/DVB (6857): c...
192
193
  	if (i2c_debug) {
  		if (joined)
9c8ced511   Steven Toth   V4L/DVB (9251): c...
194
  			dprintk(1, " R");
5e3c5967d   Chris Pascoe   V4L/DVB (6857): c...
195
  		else
9c8ced511   Steven Toth   V4L/DVB (9251): c...
196
  			dprintk(1, " <R %02x", (msg->addr << 1) + 1);
5e3c5967d   Chris Pascoe   V4L/DVB (6857): c...
197
  	}
e92adc2c3   Steven Toth   V4L/DVB (6404): c...
198

9c8ced511   Steven Toth   V4L/DVB (9251): c...
199
  	for (cnt = 0; cnt < msg->len; cnt++) {
d19770e51   Steven Toth   V4L/DVB (6150): A...
200
201
  
  		ctrl = bus->i2c_period | (1 << 12) | (1 << 2) | 1;
e92adc2c3   Steven Toth   V4L/DVB (6404): c...
202
  		if (cnt < msg->len - 1)
d19770e51   Steven Toth   V4L/DVB (6150): A...
203
204
205
206
207
208
209
210
211
212
213
214
  			ctrl |= I2C_NOSTOP | I2C_EXTEND;
  
  		cx_write(bus->reg_addr, msg->addr << 25);
  		cx_write(bus->reg_ctrl, ctrl);
  
  		retval = i2c_wait_done(i2c_adap);
  		if (retval < 0)
  			goto err;
  		if (retval == 0)
  			goto eio;
  		msg->buf[cnt] = cx_read(bus->reg_rdata) & 0xff;
  		if (i2c_debug) {
9c8ced511   Steven Toth   V4L/DVB (9251): c...
215
  			dprintk(1, " %02x", msg->buf[cnt]);
d19770e51   Steven Toth   V4L/DVB (6150): A...
216
  			if (!(ctrl & I2C_NOSTOP))
9c8ced511   Steven Toth   V4L/DVB (9251): c...
217
218
  				dprintk(1, " >
  ");
d19770e51   Steven Toth   V4L/DVB (6150): A...
219
220
221
222
223
224
225
  		}
  	}
  	return msg->len;
  
   eio:
  	retval = -EIO;
   err:
5e3c5967d   Chris Pascoe   V4L/DVB (6857): c...
226
  	if (i2c_debug)
9c8ced511   Steven Toth   V4L/DVB (9251): c...
227
228
  		printk(KERN_ERR " ERR: %d
  ", retval);
d19770e51   Steven Toth   V4L/DVB (6150): A...
229
230
  	return retval;
  }
44a6481dc   Michael Krufky   V4L/DVB (6162): c...
231
232
  static int i2c_xfer(struct i2c_adapter *i2c_adap,
  		    struct i2c_msg *msgs, int num)
d19770e51   Steven Toth   V4L/DVB (6150): A...
233
234
235
236
  {
  	struct cx23885_i2c *bus = i2c_adap->algo_data;
  	struct cx23885_dev *dev = bus->dev;
  	int i, retval = 0;
22b4e64f0   Harvey Harrison   V4L/DVB (7520): m...
237
238
  	dprintk(1, "%s(num = %d)
  ", __func__, num);
d19770e51   Steven Toth   V4L/DVB (6150): A...
239
240
  
  	for (i = 0 ; i < num; i++) {
44a6481dc   Michael Krufky   V4L/DVB (6162): c...
241
242
  		dprintk(1, "%s(num = %d) addr = 0x%02x  len = 0x%x
  ",
22b4e64f0   Harvey Harrison   V4L/DVB (7520): m...
243
  			__func__, num, msgs[i].addr, msgs[i].len);
d19770e51   Steven Toth   V4L/DVB (6150): A...
244
245
  		if (msgs[i].flags & I2C_M_RD) {
  			/* read */
5e3c5967d   Chris Pascoe   V4L/DVB (6857): c...
246
247
248
249
250
251
  			retval = i2c_readbytes(i2c_adap, &msgs[i], 0);
  		} else if (i + 1 < num && (msgs[i + 1].flags & I2C_M_RD) &&
  			   msgs[i].addr == msgs[i + 1].addr) {
  			/* write then read from same address */
  			retval = i2c_sendbytes(i2c_adap, &msgs[i],
  					       msgs[i + 1].len);
d19770e51   Steven Toth   V4L/DVB (6150): A...
252
253
  			if (retval < 0)
  				goto err;
5e3c5967d   Chris Pascoe   V4L/DVB (6857): c...
254
255
  			i++;
  			retval = i2c_readbytes(i2c_adap, &msgs[i], 1);
d19770e51   Steven Toth   V4L/DVB (6150): A...
256
257
  		} else {
  			/* write */
5e3c5967d   Chris Pascoe   V4L/DVB (6857): c...
258
  			retval = i2c_sendbytes(i2c_adap, &msgs[i], 0);
d19770e51   Steven Toth   V4L/DVB (6150): A...
259
  		}
5e3c5967d   Chris Pascoe   V4L/DVB (6857): c...
260
261
  		if (retval < 0)
  			goto err;
d19770e51   Steven Toth   V4L/DVB (6150): A...
262
263
264
265
266
267
268
269
270
  	}
  	return num;
  
   err:
  	return retval;
  }
  
  static int attach_inform(struct i2c_client *client)
  {
7b8880140   Steven Toth   V4L/DVB (7007): c...
271
272
273
  	struct cx23885_i2c *bus = i2c_get_adapdata(client->adapter);
  	struct cx23885_dev *dev = bus->dev;
  	struct tuner_setup tun_setup;
d19770e51   Steven Toth   V4L/DVB (6150): A...
274
275
276
277
278
279
280
  
  	dprintk(1, "%s i2c attach [addr=0x%x,client=%s]
  ",
  		client->driver->driver.name, client->addr, client->name);
  
  	if (!client->driver->command)
  		return 0;
7b8880140   Steven Toth   V4L/DVB (7007): c...
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
  	if (dev->tuner_type != UNSET) {
  
  		dprintk(1, "%s  (tuner) i2c attach [addr=0x%x,client=%s]
  ",
  			client->driver->driver.name, client->addr,
  			client->name);
  
  		if ((dev->tuner_addr == ADDR_UNSET) ||
  			(dev->tuner_addr == client->addr)) {
  
  			dprintk(1, "%s (tuner || addr UNSET)
  ",
  				client->driver->driver.name);
  
  			dprintk(1, "%s i2c attach [addr=0x%x,client=%s]
  ",
  				client->driver->driver.name,
  				client->addr, client->name);
  
  			tun_setup.mode_mask = T_ANALOG_TV;
  			tun_setup.type = dev->tuner_type;
  			tun_setup.addr = dev->tuner_addr;
  
  			client->driver->command(client, TUNER_SET_TYPE_ADDR,
  				&tun_setup);
  		}
  	}
d19770e51   Steven Toth   V4L/DVB (6150): A...
308
309
310
311
312
313
314
315
316
317
318
319
  	return 0;
  }
  
  static int detach_inform(struct i2c_client *client)
  {
  	struct cx23885_dev *dev = i2c_get_adapdata(client->adapter);
  
  	dprintk(1, "i2c detach [client=%s]
  ", client->name);
  
  	return 0;
  }
44a6481dc   Michael Krufky   V4L/DVB (6162): c...
320
321
  void cx23885_call_i2c_clients(struct cx23885_i2c *bus,
  			      unsigned int cmd, void *arg)
d19770e51   Steven Toth   V4L/DVB (6150): A...
322
  {
d19770e51   Steven Toth   V4L/DVB (6150): A...
323
324
  	if (bus->i2c_rc != 0)
  		return;
60a41d3b6   Michael Krufky   V4L/DVB (6163): c...
325
  	i2c_clients_command(&bus->i2c_adap, cmd, arg);
d19770e51   Steven Toth   V4L/DVB (6150): A...
326
  }
d19770e51   Steven Toth   V4L/DVB (6150): A...
327
328
  static u32 cx23885_functionality(struct i2c_adapter *adap)
  {
0fc0739ba   Steven Toth   V4L/DVB (6156): A...
329
  	return I2C_FUNC_SMBUS_EMUL | I2C_FUNC_I2C;
d19770e51   Steven Toth   V4L/DVB (6150): A...
330
331
332
333
  }
  
  static struct i2c_algorithm cx23885_i2c_algo_template = {
  	.master_xfer	= i2c_xfer,
d19770e51   Steven Toth   V4L/DVB (6150): A...
334
335
336
337
338
339
340
341
342
343
  	.functionality	= cx23885_functionality,
  };
  
  /* ----------------------------------------------------------------------- */
  
  static struct i2c_adapter cx23885_i2c_adap_template = {
  	.name              = "cx23885",
  	.owner             = THIS_MODULE,
  	.id                = I2C_HW_B_CX23885,
  	.algo              = &cx23885_i2c_algo_template,
7b8880140   Steven Toth   V4L/DVB (7007): c...
344
  	.class             = I2C_CLASS_TV_ANALOG,
d19770e51   Steven Toth   V4L/DVB (6150): A...
345
346
347
348
349
350
351
352
353
  	.client_register   = attach_inform,
  	.client_unregister = detach_inform,
  };
  
  static struct i2c_client cx23885_i2c_client_template = {
  	.name	= "cx23885 internal",
  };
  
  static char *i2c_devs[128] = {
9c8ced511   Steven Toth   V4L/DVB (9251): c...
354
355
356
357
358
359
360
361
362
  	[0x10 >> 1] = "tda10048",
  	[0x12 >> 1] = "dib7000pc",
  	[0x1c >> 1] = "lgdt3303",
  	[0x86 >> 1] = "tda9887",
  	[0x32 >> 1] = "cx24227",
  	[0x88 >> 1] = "cx25837",
  	[0x84 >> 1] = "tda8295",
  	[0xa0 >> 1] = "eeprom",
  	[0xc0 >> 1] = "tuner/mt2131/tda8275",
667623739   Steven Toth   V4L/DVB (7673): c...
363
  	[0xc2 >> 1] = "tuner/mt2131/tda8275/xc5000/xc3028",
9c8ced511   Steven Toth   V4L/DVB (9251): c...
364
  	[0xc8 >> 1] = "tuner/xc3028L",
d19770e51   Steven Toth   V4L/DVB (6150): A...
365
366
367
368
369
  };
  
  static void do_i2c_scan(char *name, struct i2c_client *c)
  {
  	unsigned char buf;
44a6481dc   Michael Krufky   V4L/DVB (6162): c...
370
  	int i, rc;
d19770e51   Steven Toth   V4L/DVB (6150): A...
371
372
373
  
  	for (i = 0; i < 128; i++) {
  		c->addr = i;
44a6481dc   Michael Krufky   V4L/DVB (6162): c...
374
  		rc = i2c_master_recv(c, &buf, 0);
d19770e51   Steven Toth   V4L/DVB (6150): A...
375
376
  		if (rc < 0)
  			continue;
9c8ced511   Steven Toth   V4L/DVB (9251): c...
377
378
  		printk(KERN_INFO "%s: i2c scan: found device @ 0x%x  [%s]
  ",
d19770e51   Steven Toth   V4L/DVB (6150): A...
379
380
381
382
383
384
385
386
  		       name, i << 1, i2c_devs[i] ? i2c_devs[i] : "???");
  	}
  }
  
  /* init + register i2c algo-bit adapter */
  int cx23885_i2c_register(struct cx23885_i2c *bus)
  {
  	struct cx23885_dev *dev = bus->dev;
22b4e64f0   Harvey Harrison   V4L/DVB (7520): m...
387
388
  	dprintk(1, "%s(bus = %d)
  ", __func__, bus->nr);
d19770e51   Steven Toth   V4L/DVB (6150): A...
389

44a6481dc   Michael Krufky   V4L/DVB (6162): c...
390
391
392
393
394
395
  	memcpy(&bus->i2c_adap, &cx23885_i2c_adap_template,
  	       sizeof(bus->i2c_adap));
  	memcpy(&bus->i2c_algo, &cx23885_i2c_algo_template,
  	       sizeof(bus->i2c_algo));
  	memcpy(&bus->i2c_client, &cx23885_i2c_client_template,
  	       sizeof(bus->i2c_client));
d19770e51   Steven Toth   V4L/DVB (6150): A...
396
397
  
  	bus->i2c_adap.dev.parent = &dev->pci->dev;
44a6481dc   Michael Krufky   V4L/DVB (6162): c...
398
399
  	strlcpy(bus->i2c_adap.name, bus->dev->name,
  		sizeof(bus->i2c_adap.name));
2e52f215b   Steven Toth   V4L/DVB (6170): c...
400

d19770e51   Steven Toth   V4L/DVB (6150): A...
401
402
  	bus->i2c_algo.data = bus;
  	bus->i2c_adap.algo_data = bus;
7b8880140   Steven Toth   V4L/DVB (7007): c...
403
  	i2c_set_adapdata(&bus->i2c_adap, bus);
d19770e51   Steven Toth   V4L/DVB (6150): A...
404
405
406
407
408
  	i2c_add_adapter(&bus->i2c_adap);
  
  	bus->i2c_client.adapter = &bus->i2c_adap;
  
  	if (0 == bus->i2c_rc) {
9c8ced511   Steven Toth   V4L/DVB (9251): c...
409
410
  		dprintk(1, "%s: i2c bus %d registered
  ", dev->name, bus->nr);
d19770e51   Steven Toth   V4L/DVB (6150): A...
411
412
413
  		if (i2c_scan)
  			do_i2c_scan(dev->name, &bus->i2c_client);
  	} else
9c8ced511   Steven Toth   V4L/DVB (9251): c...
414
415
416
  		printk(KERN_WARNING "%s: i2c bus %d register FAILED
  ",
  			dev->name, bus->nr);
d19770e51   Steven Toth   V4L/DVB (6150): A...
417
418
419
420
421
422
423
424
425
  
  	return bus->i2c_rc;
  }
  
  int cx23885_i2c_unregister(struct cx23885_i2c *bus)
  {
  	i2c_del_adapter(&bus->i2c_adap);
  	return 0;
  }
a589b6654   Steven Toth   V4L/DVB (7726): c...
426
427
428
429
430
431
432
433
434
435
436
437
438
439
440
441
442
443
444
445
446
447
448
  void cx23885_av_clk(struct cx23885_dev *dev, int enable)
  {
  	/* write 0 to bus 2 addr 0x144 via i2x_xfer() */
  	char buffer[3];
  	struct i2c_msg msg;
  	dprintk(1, "%s(enabled = %d)
  ", __func__, enable);
  
  	/* Register 0x144 */
  	buffer[0] = 0x01;
  	buffer[1] = 0x44;
  	if (enable == 1)
  		buffer[2] = 0x05;
  	else
  		buffer[2] = 0x00;
  
  	msg.addr = 0x44;
  	msg.flags = I2C_M_TEN;
  	msg.len = 3;
  	msg.buf = buffer;
  
  	i2c_xfer(&dev->i2c_bus[2].i2c_adap, &msg, 1);
  }
d19770e51   Steven Toth   V4L/DVB (6150): A...
449
  /* ----------------------------------------------------------------------- */
d19770e51   Steven Toth   V4L/DVB (6150): A...
450
451
452
453
454
  /*
   * Local variables:
   * c-basic-offset: 8
   * End:
   */