Commit | Line | Data |
---|---|---|
d19770e5 ST |
1 | /* |
2 | * Driver for the Conexant CX23885 PCIe bridge | |
3 | * | |
4 | * Copyright (c) 2006 Steven Toth <stoth@hauppauge.com> | |
5 | * | |
6 | * This program is free software; you can redistribute it and/or modify | |
7 | * it under the terms of the GNU General Public License as published by | |
8 | * the Free Software Foundation; either version 2 of the License, or | |
9 | * (at your option) any later version. | |
10 | * | |
11 | * This program is distributed in the hope that it will be useful, | |
12 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
13 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
14 | * | |
15 | * GNU General Public License for more details. | |
16 | * | |
17 | * You should have received a copy of the GNU General Public License | |
18 | * along with this program; if not, write to the Free Software | |
19 | * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | |
20 | */ | |
21 | ||
22 | #include <linux/module.h> | |
23 | #include <linux/moduleparam.h> | |
24 | #include <linux/init.h> | |
25 | #include <linux/delay.h> | |
26 | #include <asm/io.h> | |
27 | ||
28 | #include "cx23885.h" | |
29 | ||
30 | #include <media/v4l2-common.h> | |
31 | ||
3c5666ae | 32 | static unsigned int i2c_debug = 0; |
d19770e5 | 33 | module_param(i2c_debug, int, 0644); |
44a6481d | 34 | MODULE_PARM_DESC(i2c_debug, "enable debug messages [i2c]"); |
d19770e5 ST |
35 | |
36 | static unsigned int i2c_scan = 0; | |
37 | module_param(i2c_scan, int, 0444); | |
44a6481d | 38 | MODULE_PARM_DESC(i2c_scan, "scan i2c bus at insmod time"); |
d19770e5 | 39 | |
5e3c5967 CP |
40 | #define dprintk(level, fmt, arg...) do { \ |
41 | if (i2c_debug >= level) \ | |
42 | printk(KERN_DEBUG "%s: " fmt, dev->name , ## arg); \ | |
43 | } while (0) | |
d19770e5 ST |
44 | |
45 | #define I2C_WAIT_DELAY 32 | |
46 | #define I2C_WAIT_RETRY 64 | |
47 | ||
48 | #define I2C_EXTEND (1 << 3) | |
49 | #define I2C_NOSTOP (1 << 4) | |
50 | ||
51 | static inline int i2c_slave_did_ack(struct i2c_adapter *i2c_adap) | |
52 | { | |
53 | struct cx23885_i2c *bus = i2c_adap->algo_data; | |
54 | struct cx23885_dev *dev = bus->dev; | |
55 | return cx_read(bus->reg_stat) & 0x01; | |
56 | } | |
57 | ||
58 | static inline int i2c_is_busy(struct i2c_adapter *i2c_adap) | |
59 | { | |
60 | struct cx23885_i2c *bus = i2c_adap->algo_data; | |
61 | struct cx23885_dev *dev = bus->dev; | |
62 | return cx_read(bus->reg_stat) & 0x02 ? 1 : 0; | |
63 | } | |
64 | ||
65 | static int i2c_wait_done(struct i2c_adapter *i2c_adap) | |
66 | { | |
67 | int count; | |
68 | ||
69 | for (count = 0; count < I2C_WAIT_RETRY; count++) { | |
70 | if (!i2c_is_busy(i2c_adap)) | |
71 | break; | |
72 | udelay(I2C_WAIT_DELAY); | |
73 | } | |
74 | ||
75 | if (I2C_WAIT_RETRY == count) | |
76 | return 0; | |
77 | ||
78 | return 1; | |
79 | } | |
80 | ||
44a6481d | 81 | static int i2c_sendbytes(struct i2c_adapter *i2c_adap, |
5e3c5967 | 82 | const struct i2c_msg *msg, int joined_rlen) |
d19770e5 ST |
83 | { |
84 | struct cx23885_i2c *bus = i2c_adap->algo_data; | |
85 | struct cx23885_dev *dev = bus->dev; | |
86 | u32 wdata, addr, ctrl; | |
87 | int retval, cnt; | |
88 | ||
5e3c5967 CP |
89 | if (joined_rlen) |
90 | dprintk(1, "%s(msg->wlen=%d, nextmsg->rlen=%d)\n", __FUNCTION__, | |
91 | msg->len, joined_rlen); | |
92 | else | |
93 | dprintk(1, "%s(msg->len=%d)\n", __FUNCTION__, msg->len); | |
e92adc2c | 94 | |
d19770e5 ST |
95 | /* Deal with i2c probe functions with zero payload */ |
96 | if (msg->len == 0) { | |
97 | cx_write(bus->reg_addr, msg->addr << 25); | |
98 | cx_write(bus->reg_ctrl, bus->i2c_period | (1 << 2)); | |
99 | if (!i2c_wait_done(i2c_adap)) | |
100 | return -EIO; | |
101 | if (!i2c_slave_did_ack(i2c_adap)) | |
102 | return -EIO; | |
103 | ||
104 | dprintk(1, "%s() returns 0\n", __FUNCTION__); | |
105 | return 0; | |
106 | } | |
107 | ||
108 | ||
109 | /* dev, reg + first byte */ | |
110 | addr = (msg->addr << 25) | msg->buf[0]; | |
111 | wdata = msg->buf[0]; | |
112 | ctrl = bus->i2c_period | (1 << 12) | (1 << 2); | |
113 | ||
114 | if (msg->len > 1) | |
115 | ctrl |= I2C_NOSTOP | I2C_EXTEND; | |
5e3c5967 CP |
116 | else if (joined_rlen) |
117 | ctrl |= I2C_NOSTOP; | |
d19770e5 ST |
118 | |
119 | cx_write(bus->reg_addr, addr); | |
120 | cx_write(bus->reg_wdata, wdata); | |
121 | cx_write(bus->reg_ctrl, ctrl); | |
122 | ||
123 | retval = i2c_wait_done(i2c_adap); | |
124 | if (retval < 0) | |
125 | goto err; | |
126 | if (retval == 0) | |
127 | goto eio; | |
128 | if (i2c_debug) { | |
129 | printk(" <W %02x %02x", msg->addr << 1, msg->buf[0]); | |
130 | if (!(ctrl & I2C_NOSTOP)) | |
131 | printk(" >\n"); | |
132 | } | |
133 | ||
134 | for (cnt = 1; cnt < msg->len; cnt++ ) { | |
135 | /* following bytes */ | |
136 | wdata = msg->buf[cnt]; | |
137 | ctrl = bus->i2c_period | (1 << 12) | (1 << 2); | |
138 | ||
e92adc2c | 139 | if (cnt < msg->len - 1) |
d19770e5 | 140 | ctrl |= I2C_NOSTOP | I2C_EXTEND; |
5e3c5967 CP |
141 | else if (joined_rlen) |
142 | ctrl |= I2C_NOSTOP; | |
d19770e5 | 143 | |
d19770e5 ST |
144 | cx_write(bus->reg_addr, addr); |
145 | cx_write(bus->reg_wdata, wdata); | |
146 | cx_write(bus->reg_ctrl, ctrl); | |
147 | ||
148 | retval = i2c_wait_done(i2c_adap); | |
149 | if (retval < 0) | |
150 | goto err; | |
151 | if (retval == 0) | |
152 | goto eio; | |
153 | if (i2c_debug) { | |
154 | printk(" %02x", msg->buf[cnt]); | |
155 | if (!(ctrl & I2C_NOSTOP)) | |
156 | printk(" >\n"); | |
157 | } | |
158 | } | |
159 | return msg->len; | |
160 | ||
161 | eio: | |
162 | retval = -EIO; | |
163 | err: | |
5e3c5967 CP |
164 | if (i2c_debug) |
165 | printk(" ERR: %d\n", retval); | |
d19770e5 ST |
166 | return retval; |
167 | } | |
168 | ||
44a6481d | 169 | static int i2c_readbytes(struct i2c_adapter *i2c_adap, |
5e3c5967 | 170 | const struct i2c_msg *msg, int joined) |
d19770e5 ST |
171 | { |
172 | struct cx23885_i2c *bus = i2c_adap->algo_data; | |
173 | struct cx23885_dev *dev = bus->dev; | |
174 | u32 ctrl, cnt; | |
175 | int retval; | |
176 | ||
5e3c5967 CP |
177 | |
178 | if (i2c_debug && !joined) | |
179 | dprintk(1, "%s(msg->len=%d)\n", __FUNCTION__, msg->len); | |
d19770e5 ST |
180 | |
181 | /* Deal with i2c probe functions with zero payload */ | |
182 | if (msg->len == 0) { | |
183 | cx_write(bus->reg_addr, msg->addr << 25); | |
184 | cx_write(bus->reg_ctrl, bus->i2c_period | (1 << 2) | 1); | |
185 | if (!i2c_wait_done(i2c_adap)) | |
186 | return -EIO; | |
187 | if (!i2c_slave_did_ack(i2c_adap)) | |
188 | return -EIO; | |
189 | ||
190 | ||
191 | dprintk(1, "%s() returns 0\n", __FUNCTION__); | |
192 | return 0; | |
193 | } | |
194 | ||
5e3c5967 CP |
195 | if (i2c_debug) { |
196 | if (joined) | |
197 | printk(" R"); | |
198 | else | |
199 | printk(" <R %02x", (msg->addr << 1) + 1); | |
200 | } | |
e92adc2c | 201 | |
d19770e5 ST |
202 | for(cnt = 0; cnt < msg->len; cnt++) { |
203 | ||
204 | ctrl = bus->i2c_period | (1 << 12) | (1 << 2) | 1; | |
205 | ||
e92adc2c | 206 | if (cnt < msg->len - 1) |
d19770e5 ST |
207 | ctrl |= I2C_NOSTOP | I2C_EXTEND; |
208 | ||
209 | cx_write(bus->reg_addr, msg->addr << 25); | |
210 | cx_write(bus->reg_ctrl, ctrl); | |
211 | ||
212 | retval = i2c_wait_done(i2c_adap); | |
213 | if (retval < 0) | |
214 | goto err; | |
215 | if (retval == 0) | |
216 | goto eio; | |
217 | msg->buf[cnt] = cx_read(bus->reg_rdata) & 0xff; | |
218 | if (i2c_debug) { | |
e92adc2c | 219 | printk(" %02x", msg->buf[cnt]); |
d19770e5 ST |
220 | if (!(ctrl & I2C_NOSTOP)) |
221 | printk(" >\n"); | |
222 | } | |
223 | } | |
224 | return msg->len; | |
225 | ||
226 | eio: | |
227 | retval = -EIO; | |
228 | err: | |
5e3c5967 CP |
229 | if (i2c_debug) |
230 | printk(" ERR: %d\n", retval); | |
d19770e5 ST |
231 | return retval; |
232 | } | |
233 | ||
44a6481d MK |
234 | static int i2c_xfer(struct i2c_adapter *i2c_adap, |
235 | struct i2c_msg *msgs, int num) | |
d19770e5 ST |
236 | { |
237 | struct cx23885_i2c *bus = i2c_adap->algo_data; | |
238 | struct cx23885_dev *dev = bus->dev; | |
239 | int i, retval = 0; | |
240 | ||
241 | dprintk(1, "%s(num = %d)\n", __FUNCTION__, num); | |
242 | ||
243 | for (i = 0 ; i < num; i++) { | |
44a6481d MK |
244 | dprintk(1, "%s(num = %d) addr = 0x%02x len = 0x%x\n", |
245 | __FUNCTION__, num, msgs[i].addr, msgs[i].len); | |
d19770e5 ST |
246 | if (msgs[i].flags & I2C_M_RD) { |
247 | /* read */ | |
5e3c5967 CP |
248 | retval = i2c_readbytes(i2c_adap, &msgs[i], 0); |
249 | } else if (i + 1 < num && (msgs[i + 1].flags & I2C_M_RD) && | |
250 | msgs[i].addr == msgs[i + 1].addr) { | |
251 | /* write then read from same address */ | |
252 | retval = i2c_sendbytes(i2c_adap, &msgs[i], | |
253 | msgs[i + 1].len); | |
d19770e5 ST |
254 | if (retval < 0) |
255 | goto err; | |
5e3c5967 CP |
256 | i++; |
257 | retval = i2c_readbytes(i2c_adap, &msgs[i], 1); | |
d19770e5 ST |
258 | } else { |
259 | /* write */ | |
5e3c5967 | 260 | retval = i2c_sendbytes(i2c_adap, &msgs[i], 0); |
d19770e5 | 261 | } |
5e3c5967 CP |
262 | if (retval < 0) |
263 | goto err; | |
d19770e5 ST |
264 | } |
265 | return num; | |
266 | ||
267 | err: | |
268 | return retval; | |
269 | } | |
270 | ||
271 | static int attach_inform(struct i2c_client *client) | |
272 | { | |
273 | struct cx23885_dev *dev = i2c_get_adapdata(client->adapter); | |
274 | ||
275 | dprintk(1, "%s i2c attach [addr=0x%x,client=%s]\n", | |
276 | client->driver->driver.name, client->addr, client->name); | |
277 | ||
278 | if (!client->driver->command) | |
279 | return 0; | |
280 | ||
281 | return 0; | |
282 | } | |
283 | ||
284 | static int detach_inform(struct i2c_client *client) | |
285 | { | |
286 | struct cx23885_dev *dev = i2c_get_adapdata(client->adapter); | |
287 | ||
288 | dprintk(1, "i2c detach [client=%s]\n", client->name); | |
289 | ||
290 | return 0; | |
291 | } | |
292 | ||
44a6481d MK |
293 | void cx23885_call_i2c_clients(struct cx23885_i2c *bus, |
294 | unsigned int cmd, void *arg) | |
d19770e5 | 295 | { |
d19770e5 ST |
296 | if (bus->i2c_rc != 0) |
297 | return; | |
298 | ||
60a41d3b | 299 | i2c_clients_command(&bus->i2c_adap, cmd, arg); |
d19770e5 ST |
300 | } |
301 | ||
d19770e5 ST |
302 | static u32 cx23885_functionality(struct i2c_adapter *adap) |
303 | { | |
0fc0739b | 304 | return I2C_FUNC_SMBUS_EMUL | I2C_FUNC_I2C; |
d19770e5 ST |
305 | } |
306 | ||
307 | static struct i2c_algorithm cx23885_i2c_algo_template = { | |
308 | .master_xfer = i2c_xfer, | |
d19770e5 ST |
309 | .functionality = cx23885_functionality, |
310 | }; | |
311 | ||
312 | /* ----------------------------------------------------------------------- */ | |
313 | ||
314 | static struct i2c_adapter cx23885_i2c_adap_template = { | |
315 | .name = "cx23885", | |
316 | .owner = THIS_MODULE, | |
317 | .id = I2C_HW_B_CX23885, | |
318 | .algo = &cx23885_i2c_algo_template, | |
d19770e5 ST |
319 | .client_register = attach_inform, |
320 | .client_unregister = detach_inform, | |
321 | }; | |
322 | ||
323 | static struct i2c_client cx23885_i2c_client_template = { | |
324 | .name = "cx23885 internal", | |
325 | }; | |
326 | ||
327 | static char *i2c_devs[128] = { | |
9bc37caa MK |
328 | [ 0x1c >> 1 ] = "lgdt3303", |
329 | [ 0x86 >> 1 ] = "tda9887", | |
d19770e5 ST |
330 | [ 0x32 >> 1 ] = "cx24227", |
331 | [ 0x88 >> 1 ] = "cx25837", | |
332 | [ 0x84 >> 1 ] = "tda8295", | |
333 | [ 0xa0 >> 1 ] = "eeprom", | |
9bc37caa | 334 | [ 0xc0 >> 1 ] = "tuner/mt2131/tda8275", |
d1987d55 | 335 | [ 0xc2 >> 1 ] = "tuner/mt2131/tda8275/xc5000", |
d19770e5 ST |
336 | }; |
337 | ||
338 | static void do_i2c_scan(char *name, struct i2c_client *c) | |
339 | { | |
340 | unsigned char buf; | |
44a6481d | 341 | int i, rc; |
d19770e5 ST |
342 | |
343 | for (i = 0; i < 128; i++) { | |
344 | c->addr = i; | |
44a6481d | 345 | rc = i2c_master_recv(c, &buf, 0); |
d19770e5 ST |
346 | if (rc < 0) |
347 | continue; | |
348 | printk("%s: i2c scan: found device @ 0x%x [%s]\n", | |
349 | name, i << 1, i2c_devs[i] ? i2c_devs[i] : "???"); | |
350 | } | |
351 | } | |
352 | ||
353 | /* init + register i2c algo-bit adapter */ | |
354 | int cx23885_i2c_register(struct cx23885_i2c *bus) | |
355 | { | |
356 | struct cx23885_dev *dev = bus->dev; | |
357 | ||
358 | dprintk(1, "%s(bus = %d)\n", __FUNCTION__, bus->nr); | |
359 | ||
44a6481d MK |
360 | memcpy(&bus->i2c_adap, &cx23885_i2c_adap_template, |
361 | sizeof(bus->i2c_adap)); | |
362 | memcpy(&bus->i2c_algo, &cx23885_i2c_algo_template, | |
363 | sizeof(bus->i2c_algo)); | |
364 | memcpy(&bus->i2c_client, &cx23885_i2c_client_template, | |
365 | sizeof(bus->i2c_client)); | |
d19770e5 ST |
366 | |
367 | bus->i2c_adap.dev.parent = &dev->pci->dev; | |
368 | ||
44a6481d MK |
369 | strlcpy(bus->i2c_adap.name, bus->dev->name, |
370 | sizeof(bus->i2c_adap.name)); | |
2e52f215 | 371 | |
d19770e5 ST |
372 | bus->i2c_algo.data = bus; |
373 | bus->i2c_adap.algo_data = bus; | |
374 | i2c_add_adapter(&bus->i2c_adap); | |
375 | ||
376 | bus->i2c_client.adapter = &bus->i2c_adap; | |
377 | ||
378 | if (0 == bus->i2c_rc) { | |
379 | printk("%s: i2c bus %d registered\n", dev->name, bus->nr); | |
380 | if (i2c_scan) | |
381 | do_i2c_scan(dev->name, &bus->i2c_client); | |
382 | } else | |
383 | printk("%s: i2c bus %d register FAILED\n", dev->name, bus->nr); | |
384 | ||
385 | return bus->i2c_rc; | |
386 | } | |
387 | ||
388 | int cx23885_i2c_unregister(struct cx23885_i2c *bus) | |
389 | { | |
390 | i2c_del_adapter(&bus->i2c_adap); | |
391 | return 0; | |
392 | } | |
393 | ||
394 | /* ----------------------------------------------------------------------- */ | |
395 | ||
d19770e5 ST |
396 | /* |
397 | * Local variables: | |
398 | * c-basic-offset: 8 | |
399 | * End: | |
400 | */ |