1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  *  mxl111sf-i2c.c - driver for the MaxLinear MXL111SF
4  *
5  *  Copyright (C) 2010-2014 Michael Krufky <mkrufky@linuxtv.org>
6  */
7 
8 #include "mxl111sf-i2c.h"
9 #include "mxl111sf.h"
10 
11 /* SW-I2C ----------------------------------------------------------------- */
12 
13 #define SW_I2C_ADDR		0x1a
14 #define SW_I2C_EN		0x02
15 #define SW_SCL_OUT		0x04
16 #define SW_SDA_OUT		0x08
17 #define SW_SDA_IN		0x04
18 
19 #define SW_I2C_BUSY_ADDR	0x2f
20 #define SW_I2C_BUSY		0x02
21 
22 static int mxl111sf_i2c_bitbang_sendbyte(struct mxl111sf_state *state,
23 					 u8 byte)
24 {
25 	int i, ret;
26 	u8 data = 0;
27 
28 	mxl_i2c("(0x%02x)", byte);
29 
30 	ret = mxl111sf_read_reg(state, SW_I2C_BUSY_ADDR, &data);
31 	if (mxl_fail(ret))
32 		goto fail;
33 
34 	for (i = 0; i < 8; i++) {
35 
36 		data = (byte & (0x80 >> i)) ? SW_SDA_OUT : 0;
37 
38 		ret = mxl111sf_write_reg(state, SW_I2C_ADDR,
39 					 0x10 | SW_I2C_EN | data);
40 		if (mxl_fail(ret))
41 			goto fail;
42 
43 		ret = mxl111sf_write_reg(state, SW_I2C_ADDR,
44 					 0x10 | SW_I2C_EN | data | SW_SCL_OUT);
45 		if (mxl_fail(ret))
46 			goto fail;
47 
48 		ret = mxl111sf_write_reg(state, SW_I2C_ADDR,
49 					 0x10 | SW_I2C_EN | data);
50 		if (mxl_fail(ret))
51 			goto fail;
52 	}
53 
54 	/* last bit was 0 so we need to release SDA */
55 	if (!(byte & 1)) {
56 		ret = mxl111sf_write_reg(state, SW_I2C_ADDR,
57 					 0x10 | SW_I2C_EN | SW_SDA_OUT);
58 		if (mxl_fail(ret))
59 			goto fail;
60 	}
61 
62 	/* CLK high for ACK readback */
63 	ret = mxl111sf_write_reg(state, SW_I2C_ADDR,
64 				 0x10 | SW_I2C_EN | SW_SCL_OUT | SW_SDA_OUT);
65 	if (mxl_fail(ret))
66 		goto fail;
67 
68 	ret = mxl111sf_read_reg(state, SW_I2C_BUSY_ADDR, &data);
69 	if (mxl_fail(ret))
70 		goto fail;
71 
72 	/* drop the CLK after getting ACK, SDA will go high right away */
73 	ret = mxl111sf_write_reg(state, SW_I2C_ADDR,
74 				 0x10 | SW_I2C_EN | SW_SDA_OUT);
75 	if (mxl_fail(ret))
76 		goto fail;
77 
78 	if (data & SW_SDA_IN)
79 		ret = -EIO;
80 fail:
81 	return ret;
82 }
83 
84 static int mxl111sf_i2c_bitbang_recvbyte(struct mxl111sf_state *state,
85 					 u8 *pbyte)
86 {
87 	int i, ret;
88 	u8 byte = 0;
89 	u8 data = 0;
90 
91 	mxl_i2c("()");
92 
93 	*pbyte = 0;
94 
95 	ret = mxl111sf_write_reg(state, SW_I2C_ADDR,
96 				 0x10 | SW_I2C_EN | SW_SDA_OUT);
97 	if (mxl_fail(ret))
98 		goto fail;
99 
100 	for (i = 0; i < 8; i++) {
101 		ret = mxl111sf_write_reg(state, SW_I2C_ADDR,
102 					 0x10 | SW_I2C_EN |
103 					 SW_SCL_OUT | SW_SDA_OUT);
104 		if (mxl_fail(ret))
105 			goto fail;
106 
107 		ret = mxl111sf_read_reg(state, SW_I2C_BUSY_ADDR, &data);
108 		if (mxl_fail(ret))
109 			goto fail;
110 
111 		if (data & SW_SDA_IN)
112 			byte |= (0x80 >> i);
113 
114 		ret = mxl111sf_write_reg(state, SW_I2C_ADDR,
115 					 0x10 | SW_I2C_EN | SW_SDA_OUT);
116 		if (mxl_fail(ret))
117 			goto fail;
118 	}
119 	*pbyte = byte;
120 fail:
121 	return ret;
122 }
123 
124 static int mxl111sf_i2c_start(struct mxl111sf_state *state)
125 {
126 	int ret;
127 
128 	mxl_i2c("()");
129 
130 	ret = mxl111sf_write_reg(state, SW_I2C_ADDR,
131 				 0x10 | SW_I2C_EN | SW_SCL_OUT | SW_SDA_OUT);
132 	if (mxl_fail(ret))
133 		goto fail;
134 
135 	ret = mxl111sf_write_reg(state, SW_I2C_ADDR,
136 				 0x10 | SW_I2C_EN | SW_SCL_OUT);
137 	if (mxl_fail(ret))
138 		goto fail;
139 
140 	ret = mxl111sf_write_reg(state, SW_I2C_ADDR,
141 				 0x10 | SW_I2C_EN); /* start */
142 	mxl_fail(ret);
143 fail:
144 	return ret;
145 }
146 
147 static int mxl111sf_i2c_stop(struct mxl111sf_state *state)
148 {
149 	int ret;
150 
151 	mxl_i2c("()");
152 
153 	ret = mxl111sf_write_reg(state, SW_I2C_ADDR,
154 				 0x10 | SW_I2C_EN); /* stop */
155 	if (mxl_fail(ret))
156 		goto fail;
157 
158 	ret = mxl111sf_write_reg(state, SW_I2C_ADDR,
159 				 0x10 | SW_I2C_EN | SW_SCL_OUT);
160 	if (mxl_fail(ret))
161 		goto fail;
162 
163 	ret = mxl111sf_write_reg(state, SW_I2C_ADDR,
164 				 0x10 | SW_I2C_EN | SW_SCL_OUT | SW_SDA_OUT);
165 	if (mxl_fail(ret))
166 		goto fail;
167 
168 	ret = mxl111sf_write_reg(state, SW_I2C_ADDR,
169 				 0x10 | SW_SCL_OUT | SW_SDA_OUT);
170 	mxl_fail(ret);
171 fail:
172 	return ret;
173 }
174 
175 static int mxl111sf_i2c_ack(struct mxl111sf_state *state)
176 {
177 	int ret;
178 	u8 b = 0;
179 
180 	mxl_i2c("()");
181 
182 	ret = mxl111sf_read_reg(state, SW_I2C_BUSY_ADDR, &b);
183 	if (mxl_fail(ret))
184 		goto fail;
185 
186 	ret = mxl111sf_write_reg(state, SW_I2C_ADDR,
187 				 0x10 | SW_I2C_EN);
188 	if (mxl_fail(ret))
189 		goto fail;
190 
191 	/* pull SDA low */
192 	ret = mxl111sf_write_reg(state, SW_I2C_ADDR,
193 				 0x10 | SW_I2C_EN | SW_SCL_OUT);
194 	if (mxl_fail(ret))
195 		goto fail;
196 
197 	ret = mxl111sf_write_reg(state, SW_I2C_ADDR,
198 				 0x10 | SW_I2C_EN | SW_SDA_OUT);
199 	mxl_fail(ret);
200 fail:
201 	return ret;
202 }
203 
204 static int mxl111sf_i2c_nack(struct mxl111sf_state *state)
205 {
206 	int ret;
207 
208 	mxl_i2c("()");
209 
210 	/* SDA high to signal last byte read from slave */
211 	ret = mxl111sf_write_reg(state, SW_I2C_ADDR,
212 				 0x10 | SW_I2C_EN | SW_SCL_OUT | SW_SDA_OUT);
213 	if (mxl_fail(ret))
214 		goto fail;
215 
216 	ret = mxl111sf_write_reg(state, SW_I2C_ADDR,
217 				 0x10 | SW_I2C_EN | SW_SDA_OUT);
218 	mxl_fail(ret);
219 fail:
220 	return ret;
221 }
222 
223 /* ------------------------------------------------------------------------ */
224 
225 static int mxl111sf_i2c_sw_xfer_msg(struct mxl111sf_state *state,
226 				    struct i2c_msg *msg)
227 {
228 	int i, ret;
229 
230 	mxl_i2c("()");
231 
232 	if (msg->flags & I2C_M_RD) {
233 
234 		ret = mxl111sf_i2c_start(state);
235 		if (mxl_fail(ret))
236 			goto fail;
237 
238 		ret = mxl111sf_i2c_bitbang_sendbyte(state,
239 						    (msg->addr << 1) | 0x01);
240 		if (mxl_fail(ret)) {
241 			mxl111sf_i2c_stop(state);
242 			goto fail;
243 		}
244 
245 		for (i = 0; i < msg->len; i++) {
246 			ret = mxl111sf_i2c_bitbang_recvbyte(state,
247 							    &msg->buf[i]);
248 			if (mxl_fail(ret)) {
249 				mxl111sf_i2c_stop(state);
250 				goto fail;
251 			}
252 
253 			if (i < msg->len - 1)
254 				mxl111sf_i2c_ack(state);
255 		}
256 
257 		mxl111sf_i2c_nack(state);
258 
259 		ret = mxl111sf_i2c_stop(state);
260 		if (mxl_fail(ret))
261 			goto fail;
262 
263 	} else {
264 
265 		ret = mxl111sf_i2c_start(state);
266 		if (mxl_fail(ret))
267 			goto fail;
268 
269 		ret = mxl111sf_i2c_bitbang_sendbyte(state,
270 						    (msg->addr << 1) & 0xfe);
271 		if (mxl_fail(ret)) {
272 			mxl111sf_i2c_stop(state);
273 			goto fail;
274 		}
275 
276 		for (i = 0; i < msg->len; i++) {
277 			ret = mxl111sf_i2c_bitbang_sendbyte(state,
278 							    msg->buf[i]);
279 			if (mxl_fail(ret)) {
280 				mxl111sf_i2c_stop(state);
281 				goto fail;
282 			}
283 		}
284 
285 		/* FIXME: we only want to do this on the last transaction */
286 		mxl111sf_i2c_stop(state);
287 	}
288 fail:
289 	return ret;
290 }
291 
292 /* HW-I2C ----------------------------------------------------------------- */
293 
294 #define USB_WRITE_I2C_CMD     0x99
295 #define USB_READ_I2C_CMD      0xdd
296 #define USB_END_I2C_CMD       0xfe
297 
298 #define USB_WRITE_I2C_CMD_LEN   26
299 #define USB_READ_I2C_CMD_LEN    24
300 
301 #define I2C_MUX_REG           0x30
302 #define I2C_CONTROL_REG       0x00
303 #define I2C_SLAVE_ADDR_REG    0x08
304 #define I2C_DATA_REG          0x0c
305 #define I2C_INT_STATUS_REG    0x10
306 
307 static int mxl111sf_i2c_send_data(struct mxl111sf_state *state,
308 				  u8 index, u8 *wdata)
309 {
310 	int ret = mxl111sf_ctrl_msg(state, wdata[0],
311 				    &wdata[1], 25, NULL, 0);
312 	mxl_fail(ret);
313 
314 	return ret;
315 }
316 
317 static int mxl111sf_i2c_get_data(struct mxl111sf_state *state,
318 				 u8 index, u8 *wdata, u8 *rdata)
319 {
320 	int ret = mxl111sf_ctrl_msg(state, wdata[0],
321 				    &wdata[1], 25, rdata, 24);
322 	mxl_fail(ret);
323 
324 	return ret;
325 }
326 
327 static u8 mxl111sf_i2c_check_status(struct mxl111sf_state *state)
328 {
329 	u8 status = 0;
330 	u8 buf[26];
331 
332 	mxl_i2c_adv("()");
333 
334 	buf[0] = USB_READ_I2C_CMD;
335 	buf[1] = 0x00;
336 
337 	buf[2] = I2C_INT_STATUS_REG;
338 	buf[3] = 0x00;
339 	buf[4] = 0x00;
340 
341 	buf[5] = USB_END_I2C_CMD;
342 
343 	mxl111sf_i2c_get_data(state, 0, buf, buf);
344 
345 	if (buf[1] & 0x04)
346 		status = 1;
347 
348 	return status;
349 }
350 
351 static u8 mxl111sf_i2c_check_fifo(struct mxl111sf_state *state)
352 {
353 	u8 status = 0;
354 	u8 buf[26];
355 
356 	mxl_i2c("()");
357 
358 	buf[0] = USB_READ_I2C_CMD;
359 	buf[1] = 0x00;
360 
361 	buf[2] = I2C_MUX_REG;
362 	buf[3] = 0x00;
363 	buf[4] = 0x00;
364 
365 	buf[5] = I2C_INT_STATUS_REG;
366 	buf[6] = 0x00;
367 	buf[7] = 0x00;
368 	buf[8] = USB_END_I2C_CMD;
369 
370 	mxl111sf_i2c_get_data(state, 0, buf, buf);
371 
372 	if (0x08 == (buf[1] & 0x08))
373 		status = 1;
374 
375 	if ((buf[5] & 0x02) == 0x02)
376 		mxl_i2c("(buf[5] & 0x02) == 0x02"); /* FIXME */
377 
378 	return status;
379 }
380 
381 static int mxl111sf_i2c_readagain(struct mxl111sf_state *state,
382 				  u8 count, u8 *rbuf)
383 {
384 	u8 i2c_w_data[26];
385 	u8 i2c_r_data[24];
386 	u8 i = 0;
387 	u8 fifo_status = 0;
388 	int status = 0;
389 
390 	mxl_i2c("read %d bytes", count);
391 
392 	while ((fifo_status == 0) && (i++ < 5))
393 		fifo_status = mxl111sf_i2c_check_fifo(state);
394 
395 	i2c_w_data[0] = 0xDD;
396 	i2c_w_data[1] = 0x00;
397 
398 	for (i = 2; i < 26; i++)
399 		i2c_w_data[i] = 0xFE;
400 
401 	for (i = 0; i < count; i++) {
402 		i2c_w_data[2+(i*3)] = 0x0C;
403 		i2c_w_data[3+(i*3)] = 0x00;
404 		i2c_w_data[4+(i*3)] = 0x00;
405 	}
406 
407 	mxl111sf_i2c_get_data(state, 0, i2c_w_data, i2c_r_data);
408 
409 	/* Check for I2C NACK status */
410 	if (mxl111sf_i2c_check_status(state) == 1) {
411 		mxl_i2c("error!");
412 	} else {
413 		for (i = 0; i < count; i++) {
414 			rbuf[i] = i2c_r_data[(i*3)+1];
415 			mxl_i2c("%02x\t %02x",
416 				i2c_r_data[(i*3)+1],
417 				i2c_r_data[(i*3)+2]);
418 		}
419 
420 		status = 1;
421 	}
422 
423 	return status;
424 }
425 
426 #define HWI2C400 1
427 static int mxl111sf_i2c_hw_xfer_msg(struct mxl111sf_state *state,
428 				    struct i2c_msg *msg)
429 {
430 	int i, k, ret = 0;
431 	u16 index = 0;
432 	u8 buf[26];
433 	u8 i2c_r_data[24];
434 	u16 block_len;
435 	u16 left_over_len;
436 	u8 rd_status[8];
437 	u8 ret_status;
438 	u8 readbuff[26];
439 
440 	mxl_i2c("addr: 0x%02x, read buff len: %d, write buff len: %d",
441 		msg->addr, (msg->flags & I2C_M_RD) ? msg->len : 0,
442 		(!(msg->flags & I2C_M_RD)) ? msg->len : 0);
443 
444 	for (index = 0; index < 26; index++)
445 		buf[index] = USB_END_I2C_CMD;
446 
447 	/* command to indicate data payload is destined for I2C interface */
448 	buf[0] = USB_WRITE_I2C_CMD;
449 	buf[1] = 0x00;
450 
451 	/* enable I2C interface */
452 	buf[2] = I2C_MUX_REG;
453 	buf[3] = 0x80;
454 	buf[4] = 0x00;
455 
456 	/* enable I2C interface */
457 	buf[5] = I2C_MUX_REG;
458 	buf[6] = 0x81;
459 	buf[7] = 0x00;
460 
461 	/* set Timeout register on I2C interface */
462 	buf[8] = 0x14;
463 	buf[9] = 0xff;
464 	buf[10] = 0x00;
465 #if 0
466 	/* enable Interrupts on I2C interface */
467 	buf[8] = 0x24;
468 	buf[9] = 0xF7;
469 	buf[10] = 0x00;
470 #endif
471 	buf[11] = 0x24;
472 	buf[12] = 0xF7;
473 	buf[13] = 0x00;
474 
475 	ret = mxl111sf_i2c_send_data(state, 0, buf);
476 
477 	/* write data on I2C bus */
478 	if (!(msg->flags & I2C_M_RD) && (msg->len > 0)) {
479 		mxl_i2c("%d\t%02x", msg->len, msg->buf[0]);
480 
481 		/* control register on I2C interface to initialize I2C bus */
482 		buf[2] = I2C_CONTROL_REG;
483 		buf[3] = 0x5E;
484 		buf[4] = (HWI2C400) ? 0x03 : 0x0D;
485 
486 		/* I2C Slave device Address */
487 		buf[5] = I2C_SLAVE_ADDR_REG;
488 		buf[6] = (msg->addr);
489 		buf[7] = 0x00;
490 		buf[8] = USB_END_I2C_CMD;
491 		ret = mxl111sf_i2c_send_data(state, 0, buf);
492 
493 		/* check for slave device status */
494 		if (mxl111sf_i2c_check_status(state) == 1) {
495 			mxl_i2c("NACK writing slave address %02x",
496 				msg->addr);
497 			/* if NACK, stop I2C bus and exit */
498 			buf[2] = I2C_CONTROL_REG;
499 			buf[3] = 0x4E;
500 			buf[4] = (HWI2C400) ? 0x03 : 0x0D;
501 			ret = -EIO;
502 			goto exit;
503 		}
504 
505 		/* I2C interface can do I2C operations in block of 8 bytes of
506 		   I2C data. calculation to figure out number of blocks of i2c
507 		   data required to program */
508 		block_len = (msg->len / 8);
509 		left_over_len = (msg->len % 8);
510 
511 		mxl_i2c("block_len %d, left_over_len %d",
512 			block_len, left_over_len);
513 
514 		for (index = 0; index < block_len; index++) {
515 			for (i = 0; i < 8; i++) {
516 				/* write data on I2C interface */
517 				buf[2+(i*3)] = I2C_DATA_REG;
518 				buf[3+(i*3)] = msg->buf[(index*8)+i];
519 				buf[4+(i*3)] = 0x00;
520 			}
521 
522 			ret = mxl111sf_i2c_send_data(state, 0, buf);
523 
524 			/* check for I2C NACK status */
525 			if (mxl111sf_i2c_check_status(state) == 1) {
526 				mxl_i2c("NACK writing slave address %02x",
527 					msg->addr);
528 
529 				/* if NACK, stop I2C bus and exit */
530 				buf[2] = I2C_CONTROL_REG;
531 				buf[3] = 0x4E;
532 				buf[4] = (HWI2C400) ? 0x03 : 0x0D;
533 				ret = -EIO;
534 				goto exit;
535 			}
536 
537 		}
538 
539 		if (left_over_len) {
540 			for (k = 0; k < 26; k++)
541 				buf[k] = USB_END_I2C_CMD;
542 
543 			buf[0] = 0x99;
544 			buf[1] = 0x00;
545 
546 			for (i = 0; i < left_over_len; i++) {
547 				buf[2+(i*3)] = I2C_DATA_REG;
548 				buf[3+(i*3)] = msg->buf[(index*8)+i];
549 				mxl_i2c("index = %d %d data %d",
550 					index, i, msg->buf[(index*8)+i]);
551 				buf[4+(i*3)] = 0x00;
552 			}
553 			ret = mxl111sf_i2c_send_data(state, 0, buf);
554 
555 			/* check for I2C NACK status */
556 			if (mxl111sf_i2c_check_status(state) == 1) {
557 				mxl_i2c("NACK writing slave address %02x",
558 					msg->addr);
559 
560 				/* if NACK, stop I2C bus and exit */
561 				buf[2] = I2C_CONTROL_REG;
562 				buf[3] = 0x4E;
563 				buf[4] = (HWI2C400) ? 0x03 : 0x0D;
564 				ret = -EIO;
565 				goto exit;
566 			}
567 
568 		}
569 
570 		/* issue I2C STOP after write */
571 		buf[2] = I2C_CONTROL_REG;
572 		buf[3] = 0x4E;
573 		buf[4] = (HWI2C400) ? 0x03 : 0x0D;
574 
575 	}
576 
577 	/* read data from I2C bus */
578 	if ((msg->flags & I2C_M_RD) && (msg->len > 0)) {
579 		mxl_i2c("read buf len %d", msg->len);
580 
581 		/* command to indicate data payload is
582 		   destined for I2C interface */
583 		buf[2] = I2C_CONTROL_REG;
584 		buf[3] = 0xDF;
585 		buf[4] = (HWI2C400) ? 0x03 : 0x0D;
586 
587 		/* I2C xfer length */
588 		buf[5] = 0x14;
589 		buf[6] = (msg->len & 0xFF);
590 		buf[7] = 0;
591 
592 		/* I2C slave device Address */
593 		buf[8] = I2C_SLAVE_ADDR_REG;
594 		buf[9] = msg->addr;
595 		buf[10] = 0x00;
596 		buf[11] = USB_END_I2C_CMD;
597 		ret = mxl111sf_i2c_send_data(state, 0, buf);
598 
599 		/* check for I2C NACK status */
600 		if (mxl111sf_i2c_check_status(state) == 1) {
601 			mxl_i2c("NACK reading slave address %02x",
602 				msg->addr);
603 
604 			/* if NACK, stop I2C bus and exit */
605 			buf[2] = I2C_CONTROL_REG;
606 			buf[3] = 0xC7;
607 			buf[4] = (HWI2C400) ? 0x03 : 0x0D;
608 			ret = -EIO;
609 			goto exit;
610 		}
611 
612 		/* I2C interface can do I2C operations in block of 8 bytes of
613 		   I2C data. calculation to figure out number of blocks of
614 		   i2c data required to program */
615 		block_len = ((msg->len) / 8);
616 		left_over_len = ((msg->len) % 8);
617 		index = 0;
618 
619 		mxl_i2c("block_len %d, left_over_len %d",
620 			block_len, left_over_len);
621 
622 		/* command to read data from I2C interface */
623 		buf[0] = USB_READ_I2C_CMD;
624 		buf[1] = 0x00;
625 
626 		for (index = 0; index < block_len; index++) {
627 			/* setup I2C read request packet on I2C interface */
628 			for (i = 0; i < 8; i++) {
629 				buf[2+(i*3)] = I2C_DATA_REG;
630 				buf[3+(i*3)] = 0x00;
631 				buf[4+(i*3)] = 0x00;
632 			}
633 
634 			ret = mxl111sf_i2c_get_data(state, 0, buf, i2c_r_data);
635 
636 			/* check for I2C NACK status */
637 			if (mxl111sf_i2c_check_status(state) == 1) {
638 				mxl_i2c("NACK reading slave address %02x",
639 					msg->addr);
640 
641 				/* if NACK, stop I2C bus and exit */
642 				buf[2] = I2C_CONTROL_REG;
643 				buf[3] = 0xC7;
644 				buf[4] = (HWI2C400) ? 0x03 : 0x0D;
645 				ret = -EIO;
646 				goto exit;
647 			}
648 
649 			/* copy data from i2c data payload to read buffer */
650 			for (i = 0; i < 8; i++) {
651 				rd_status[i] = i2c_r_data[(i*3)+2];
652 
653 				if (rd_status[i] == 0x04) {
654 					if (i < 7) {
655 						mxl_i2c("i2c fifo empty! @ %d",
656 							i);
657 						msg->buf[(index*8)+i] =
658 							i2c_r_data[(i*3)+1];
659 						/* read again */
660 						ret_status =
661 							mxl111sf_i2c_readagain(
662 								state, 8-(i+1),
663 								readbuff);
664 						if (ret_status == 1) {
665 							for (k = 0;
666 							     k < 8-(i+1);
667 							     k++) {
668 
669 					msg->buf[(index*8)+(k+i+1)] =
670 						readbuff[k];
671 					mxl_i2c("read data: %02x\t %02x",
672 						msg->buf[(index*8)+(k+i)],
673 						(index*8)+(k+i));
674 					mxl_i2c("read data: %02x\t %02x",
675 						msg->buf[(index*8)+(k+i+1)],
676 						readbuff[k]);
677 
678 							}
679 							goto stop_copy;
680 						} else {
681 							mxl_i2c("readagain ERROR!");
682 						}
683 					} else {
684 						msg->buf[(index*8)+i] =
685 							i2c_r_data[(i*3)+1];
686 					}
687 				} else {
688 					msg->buf[(index*8)+i] =
689 						i2c_r_data[(i*3)+1];
690 				}
691 			}
692 stop_copy:
693 			;
694 
695 		}
696 
697 		if (left_over_len) {
698 			for (k = 0; k < 26; k++)
699 				buf[k] = USB_END_I2C_CMD;
700 
701 			buf[0] = 0xDD;
702 			buf[1] = 0x00;
703 
704 			for (i = 0; i < left_over_len; i++) {
705 				buf[2+(i*3)] = I2C_DATA_REG;
706 				buf[3+(i*3)] = 0x00;
707 				buf[4+(i*3)] = 0x00;
708 			}
709 			ret = mxl111sf_i2c_get_data(state, 0, buf,
710 						    i2c_r_data);
711 
712 			/* check for I2C NACK status */
713 			if (mxl111sf_i2c_check_status(state) == 1) {
714 				mxl_i2c("NACK reading slave address %02x",
715 					msg->addr);
716 
717 				/* if NACK, stop I2C bus and exit */
718 				buf[2] = I2C_CONTROL_REG;
719 				buf[3] = 0xC7;
720 				buf[4] = (HWI2C400) ? 0x03 : 0x0D;
721 				ret = -EIO;
722 				goto exit;
723 			}
724 
725 			for (i = 0; i < left_over_len; i++) {
726 				msg->buf[(block_len*8)+i] =
727 					i2c_r_data[(i*3)+1];
728 				mxl_i2c("read data: %02x\t %02x",
729 					i2c_r_data[(i*3)+1],
730 					i2c_r_data[(i*3)+2]);
731 			}
732 		}
733 
734 		/* indicate I2C interface to issue NACK
735 		   after next I2C read op */
736 		buf[0] = USB_WRITE_I2C_CMD;
737 		buf[1] = 0x00;
738 
739 		/* control register */
740 		buf[2] = I2C_CONTROL_REG;
741 		buf[3] = 0x17;
742 		buf[4] = (HWI2C400) ? 0x03 : 0x0D;
743 
744 		buf[5] = USB_END_I2C_CMD;
745 		ret = mxl111sf_i2c_send_data(state, 0, buf);
746 
747 		/* control register */
748 		buf[2] = I2C_CONTROL_REG;
749 		buf[3] = 0xC7;
750 		buf[4] = (HWI2C400) ? 0x03 : 0x0D;
751 
752 	}
753 exit:
754 	/* STOP and disable I2C MUX */
755 	buf[0] = USB_WRITE_I2C_CMD;
756 	buf[1] = 0x00;
757 
758 	/* de-initilize I2C BUS */
759 	buf[5] = USB_END_I2C_CMD;
760 	mxl111sf_i2c_send_data(state, 0, buf);
761 
762 	/* Control Register */
763 	buf[2] = I2C_CONTROL_REG;
764 	buf[3] = 0xDF;
765 	buf[4] = 0x03;
766 
767 	/* disable I2C interface */
768 	buf[5] = I2C_MUX_REG;
769 	buf[6] = 0x00;
770 	buf[7] = 0x00;
771 
772 	/* de-initilize I2C BUS */
773 	buf[8] = USB_END_I2C_CMD;
774 	mxl111sf_i2c_send_data(state, 0, buf);
775 
776 	/* disable I2C interface */
777 	buf[2] = I2C_MUX_REG;
778 	buf[3] = 0x81;
779 	buf[4] = 0x00;
780 
781 	/* disable I2C interface */
782 	buf[5] = I2C_MUX_REG;
783 	buf[6] = 0x00;
784 	buf[7] = 0x00;
785 
786 	/* disable I2C interface */
787 	buf[8] = I2C_MUX_REG;
788 	buf[9] = 0x00;
789 	buf[10] = 0x00;
790 
791 	buf[11] = USB_END_I2C_CMD;
792 	mxl111sf_i2c_send_data(state, 0, buf);
793 
794 	return ret;
795 }
796 
797 /* ------------------------------------------------------------------------ */
798 
799 int mxl111sf_i2c_xfer(struct i2c_adapter *adap,
800 		      struct i2c_msg msg[], int num)
801 {
802 	struct dvb_usb_device *d = i2c_get_adapdata(adap);
803 	struct mxl111sf_state *state = d->priv;
804 	int hwi2c = (state->chip_rev > MXL111SF_V6);
805 	int i, ret;
806 
807 	if (mutex_lock_interruptible(&d->i2c_mutex) < 0)
808 		return -EAGAIN;
809 
810 	for (i = 0; i < num; i++) {
811 		ret = (hwi2c) ?
812 			mxl111sf_i2c_hw_xfer_msg(state, &msg[i]) :
813 			mxl111sf_i2c_sw_xfer_msg(state, &msg[i]);
814 		if (mxl_fail(ret)) {
815 			mxl_debug_adv("failed with error %d on i2c transaction %d of %d, %sing %d bytes to/from 0x%02x",
816 				      ret, i+1, num,
817 				      (msg[i].flags & I2C_M_RD) ?
818 				      "read" : "writ",
819 				      msg[i].len, msg[i].addr);
820 
821 			break;
822 		}
823 	}
824 
825 	mutex_unlock(&d->i2c_mutex);
826 
827 	return i == num ? num : -EREMOTEIO;
828 }
829