drivers/media/dvb/dvb-usb/mxl111sf-i2c.c

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