1 /* 2 * Panasonic MN88473 DVB-T/T2/C demodulator driver 3 * 4 * Copyright (C) 2014 Antti Palosaari <crope@iki.fi> 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 17 #include "mn88473_priv.h" 18 19 static int mn88473_get_tune_settings(struct dvb_frontend *fe, 20 struct dvb_frontend_tune_settings *s) 21 { 22 s->min_delay_ms = 1000; 23 return 0; 24 } 25 26 static int mn88473_set_frontend(struct dvb_frontend *fe) 27 { 28 struct i2c_client *client = fe->demodulator_priv; 29 struct mn88473_dev *dev = i2c_get_clientdata(client); 30 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 31 int ret, i; 32 unsigned int uitmp; 33 u32 if_frequency; 34 u8 delivery_system_val, if_val[3], *conf_val_ptr; 35 u8 reg_bank2_2d_val, reg_bank0_d2_val; 36 37 dev_dbg(&client->dev, 38 "delivery_system=%u modulation=%u frequency=%u bandwidth_hz=%u symbol_rate=%u inversion=%d stream_id=%d\n", 39 c->delivery_system, c->modulation, c->frequency, 40 c->bandwidth_hz, c->symbol_rate, c->inversion, c->stream_id); 41 42 if (!dev->active) { 43 ret = -EAGAIN; 44 goto err; 45 } 46 47 switch (c->delivery_system) { 48 case SYS_DVBT: 49 delivery_system_val = 0x02; 50 reg_bank2_2d_val = 0x23; 51 reg_bank0_d2_val = 0x2a; 52 break; 53 case SYS_DVBT2: 54 delivery_system_val = 0x03; 55 reg_bank2_2d_val = 0x3b; 56 reg_bank0_d2_val = 0x29; 57 break; 58 case SYS_DVBC_ANNEX_A: 59 delivery_system_val = 0x04; 60 reg_bank2_2d_val = 0x3b; 61 reg_bank0_d2_val = 0x29; 62 break; 63 default: 64 ret = -EINVAL; 65 goto err; 66 } 67 68 switch (c->delivery_system) { 69 case SYS_DVBT: 70 case SYS_DVBT2: 71 switch (c->bandwidth_hz) { 72 case 6000000: 73 conf_val_ptr = "\xe9\x55\x55\x1c\x29\x1c\x29"; 74 break; 75 case 7000000: 76 conf_val_ptr = "\xc8\x00\x00\x17\x0a\x17\x0a"; 77 break; 78 case 8000000: 79 conf_val_ptr = "\xaf\x00\x00\x11\xec\x11\xec"; 80 break; 81 default: 82 ret = -EINVAL; 83 goto err; 84 } 85 break; 86 case SYS_DVBC_ANNEX_A: 87 conf_val_ptr = "\x10\xab\x0d\xae\x1d\x9d"; 88 break; 89 default: 90 break; 91 } 92 93 /* Program tuner */ 94 if (fe->ops.tuner_ops.set_params) { 95 ret = fe->ops.tuner_ops.set_params(fe); 96 if (ret) 97 goto err; 98 } 99 100 if (fe->ops.tuner_ops.get_if_frequency) { 101 ret = fe->ops.tuner_ops.get_if_frequency(fe, &if_frequency); 102 if (ret) 103 goto err; 104 105 dev_dbg(&client->dev, "get_if_frequency=%u\n", if_frequency); 106 } else { 107 ret = -EINVAL; 108 goto err; 109 } 110 111 /* Calculate IF registers */ 112 uitmp = DIV_ROUND_CLOSEST_ULL((u64) if_frequency * 0x1000000, dev->clk); 113 if_val[0] = (uitmp >> 16) & 0xff; 114 if_val[1] = (uitmp >> 8) & 0xff; 115 if_val[2] = (uitmp >> 0) & 0xff; 116 117 ret = regmap_write(dev->regmap[2], 0x05, 0x00); 118 if (ret) 119 goto err; 120 ret = regmap_write(dev->regmap[2], 0xfb, 0x13); 121 if (ret) 122 goto err; 123 ret = regmap_write(dev->regmap[2], 0xef, 0x13); 124 if (ret) 125 goto err; 126 ret = regmap_write(dev->regmap[2], 0xf9, 0x13); 127 if (ret) 128 goto err; 129 ret = regmap_write(dev->regmap[2], 0x00, 0x18); 130 if (ret) 131 goto err; 132 ret = regmap_write(dev->regmap[2], 0x01, 0x01); 133 if (ret) 134 goto err; 135 ret = regmap_write(dev->regmap[2], 0x02, 0x21); 136 if (ret) 137 goto err; 138 ret = regmap_write(dev->regmap[2], 0x03, delivery_system_val); 139 if (ret) 140 goto err; 141 ret = regmap_write(dev->regmap[2], 0x0b, 0x00); 142 if (ret) 143 goto err; 144 145 for (i = 0; i < sizeof(if_val); i++) { 146 ret = regmap_write(dev->regmap[2], 0x10 + i, if_val[i]); 147 if (ret) 148 goto err; 149 } 150 151 switch (c->delivery_system) { 152 case SYS_DVBT: 153 case SYS_DVBT2: 154 for (i = 0; i < 7; i++) { 155 ret = regmap_write(dev->regmap[2], 0x13 + i, 156 conf_val_ptr[i]); 157 if (ret) 158 goto err; 159 } 160 break; 161 case SYS_DVBC_ANNEX_A: 162 ret = regmap_bulk_write(dev->regmap[1], 0x10, conf_val_ptr, 6); 163 if (ret) 164 goto err; 165 break; 166 default: 167 break; 168 } 169 170 ret = regmap_write(dev->regmap[2], 0x2d, reg_bank2_2d_val); 171 if (ret) 172 goto err; 173 ret = regmap_write(dev->regmap[2], 0x2e, 0x00); 174 if (ret) 175 goto err; 176 ret = regmap_write(dev->regmap[2], 0x56, 0x0d); 177 if (ret) 178 goto err; 179 ret = regmap_bulk_write(dev->regmap[0], 0x01, 180 "\xba\x13\x80\xba\x91\xdd\xe7\x28", 8); 181 if (ret) 182 goto err; 183 ret = regmap_write(dev->regmap[0], 0x0a, 0x1a); 184 if (ret) 185 goto err; 186 ret = regmap_write(dev->regmap[0], 0x13, 0x1f); 187 if (ret) 188 goto err; 189 ret = regmap_write(dev->regmap[0], 0x19, 0x03); 190 if (ret) 191 goto err; 192 ret = regmap_write(dev->regmap[0], 0x1d, 0xb0); 193 if (ret) 194 goto err; 195 ret = regmap_write(dev->regmap[0], 0x2a, 0x72); 196 if (ret) 197 goto err; 198 ret = regmap_write(dev->regmap[0], 0x2d, 0x00); 199 if (ret) 200 goto err; 201 ret = regmap_write(dev->regmap[0], 0x3c, 0x00); 202 if (ret) 203 goto err; 204 ret = regmap_write(dev->regmap[0], 0x3f, 0xf8); 205 if (ret) 206 goto err; 207 ret = regmap_bulk_write(dev->regmap[0], 0x40, "\xf4\x08", 2); 208 if (ret) 209 goto err; 210 ret = regmap_write(dev->regmap[0], 0xd2, reg_bank0_d2_val); 211 if (ret) 212 goto err; 213 ret = regmap_write(dev->regmap[0], 0xd4, 0x55); 214 if (ret) 215 goto err; 216 ret = regmap_write(dev->regmap[1], 0xbe, 0x08); 217 if (ret) 218 goto err; 219 ret = regmap_write(dev->regmap[0], 0xb2, 0x37); 220 if (ret) 221 goto err; 222 ret = regmap_write(dev->regmap[0], 0xd7, 0x04); 223 if (ret) 224 goto err; 225 226 /* Reset FSM */ 227 ret = regmap_write(dev->regmap[2], 0xf8, 0x9f); 228 if (ret) 229 goto err; 230 231 return 0; 232 err: 233 dev_dbg(&client->dev, "failed=%d\n", ret); 234 return ret; 235 } 236 237 static int mn88473_read_status(struct dvb_frontend *fe, enum fe_status *status) 238 { 239 struct i2c_client *client = fe->demodulator_priv; 240 struct mn88473_dev *dev = i2c_get_clientdata(client); 241 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 242 int ret, i, stmp; 243 unsigned int utmp, utmp1, utmp2; 244 u8 buf[5]; 245 246 if (!dev->active) { 247 ret = -EAGAIN; 248 goto err; 249 } 250 251 /* Lock detection */ 252 switch (c->delivery_system) { 253 case SYS_DVBT: 254 ret = regmap_read(dev->regmap[0], 0x62, &utmp); 255 if (ret) 256 goto err; 257 258 if (!(utmp & 0xa0)) { 259 if ((utmp & 0x0f) >= 0x09) 260 *status = FE_HAS_SIGNAL | FE_HAS_CARRIER | 261 FE_HAS_VITERBI | FE_HAS_SYNC | 262 FE_HAS_LOCK; 263 else if ((utmp & 0x0f) >= 0x03) 264 *status = FE_HAS_SIGNAL | FE_HAS_CARRIER; 265 } else { 266 *status = 0; 267 } 268 break; 269 case SYS_DVBT2: 270 ret = regmap_read(dev->regmap[2], 0x8b, &utmp); 271 if (ret) 272 goto err; 273 274 if (!(utmp & 0x40)) { 275 if ((utmp & 0x0f) >= 0x0d) 276 *status = FE_HAS_SIGNAL | FE_HAS_CARRIER | 277 FE_HAS_VITERBI | FE_HAS_SYNC | 278 FE_HAS_LOCK; 279 else if ((utmp & 0x0f) >= 0x0a) 280 *status = FE_HAS_SIGNAL | FE_HAS_CARRIER | 281 FE_HAS_VITERBI; 282 else if ((utmp & 0x0f) >= 0x07) 283 *status = FE_HAS_SIGNAL | FE_HAS_CARRIER; 284 } else { 285 *status = 0; 286 } 287 break; 288 case SYS_DVBC_ANNEX_A: 289 ret = regmap_read(dev->regmap[1], 0x85, &utmp); 290 if (ret) 291 goto err; 292 293 if (!(utmp & 0x40)) { 294 ret = regmap_read(dev->regmap[1], 0x89, &utmp); 295 if (ret) 296 goto err; 297 298 if (utmp & 0x01) 299 *status = FE_HAS_SIGNAL | FE_HAS_CARRIER | 300 FE_HAS_VITERBI | FE_HAS_SYNC | 301 FE_HAS_LOCK; 302 } else { 303 *status = 0; 304 } 305 break; 306 default: 307 ret = -EINVAL; 308 goto err; 309 } 310 311 /* Signal strength */ 312 if (*status & FE_HAS_SIGNAL) { 313 for (i = 0; i < 2; i++) { 314 ret = regmap_bulk_read(dev->regmap[2], 0x86 + i, 315 &buf[i], 1); 316 if (ret) 317 goto err; 318 } 319 320 /* AGCRD[15:6] gives us a 10bit value ([5:0] are always 0) */ 321 utmp1 = buf[0] << 8 | buf[1] << 0 | buf[0] >> 2; 322 dev_dbg(&client->dev, "strength=%u\n", utmp1); 323 324 c->strength.stat[0].scale = FE_SCALE_RELATIVE; 325 c->strength.stat[0].uvalue = utmp1; 326 } else { 327 c->strength.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 328 } 329 330 /* CNR */ 331 if (*status & FE_HAS_VITERBI && c->delivery_system == SYS_DVBT) { 332 /* DVB-T CNR */ 333 ret = regmap_bulk_read(dev->regmap[0], 0x8f, buf, 2); 334 if (ret) 335 goto err; 336 337 utmp = buf[0] << 8 | buf[1] << 0; 338 if (utmp) { 339 /* CNR[dB]: 10 * (log10(65536 / value) + 0.2) */ 340 /* log10(65536) = 80807124, 0.2 = 3355443 */ 341 stmp = div_u64(((u64)80807124 - intlog10(utmp) 342 + 3355443) * 10000, 1 << 24); 343 dev_dbg(&client->dev, "cnr=%d value=%u\n", stmp, utmp); 344 } else { 345 stmp = 0; 346 } 347 348 c->cnr.stat[0].svalue = stmp; 349 c->cnr.stat[0].scale = FE_SCALE_DECIBEL; 350 } else if (*status & FE_HAS_VITERBI && 351 c->delivery_system == SYS_DVBT2) { 352 /* DVB-T2 CNR */ 353 for (i = 0; i < 3; i++) { 354 ret = regmap_bulk_read(dev->regmap[2], 0xb7 + i, 355 &buf[i], 1); 356 if (ret) 357 goto err; 358 } 359 360 utmp = buf[1] << 8 | buf[2] << 0; 361 utmp1 = (buf[0] >> 2) & 0x01; /* 0=SISO, 1=MISO */ 362 if (utmp) { 363 if (utmp1) { 364 /* CNR[dB]: 10 * (log10(16384 / value) - 0.6) */ 365 /* log10(16384) = 70706234, 0.6 = 10066330 */ 366 stmp = div_u64(((u64)70706234 - intlog10(utmp) 367 - 10066330) * 10000, 1 << 24); 368 dev_dbg(&client->dev, "cnr=%d value=%u MISO\n", 369 stmp, utmp); 370 } else { 371 /* CNR[dB]: 10 * (log10(65536 / value) + 0.2) */ 372 /* log10(65536) = 80807124, 0.2 = 3355443 */ 373 stmp = div_u64(((u64)80807124 - intlog10(utmp) 374 + 3355443) * 10000, 1 << 24); 375 dev_dbg(&client->dev, "cnr=%d value=%u SISO\n", 376 stmp, utmp); 377 } 378 } else { 379 stmp = 0; 380 } 381 382 c->cnr.stat[0].svalue = stmp; 383 c->cnr.stat[0].scale = FE_SCALE_DECIBEL; 384 } else if (*status & FE_HAS_VITERBI && 385 c->delivery_system == SYS_DVBC_ANNEX_A) { 386 /* DVB-C CNR */ 387 ret = regmap_bulk_read(dev->regmap[1], 0xa1, buf, 4); 388 if (ret) 389 goto err; 390 391 utmp1 = buf[0] << 8 | buf[1] << 0; /* signal */ 392 utmp2 = buf[2] << 8 | buf[3] << 0; /* noise */ 393 if (utmp1 && utmp2) { 394 /* CNR[dB]: 10 * log10(8 * (signal / noise)) */ 395 /* log10(8) = 15151336 */ 396 stmp = div_u64(((u64)15151336 + intlog10(utmp1) 397 - intlog10(utmp2)) * 10000, 1 << 24); 398 dev_dbg(&client->dev, "cnr=%d signal=%u noise=%u\n", 399 stmp, utmp1, utmp2); 400 } else { 401 stmp = 0; 402 } 403 404 c->cnr.stat[0].svalue = stmp; 405 c->cnr.stat[0].scale = FE_SCALE_DECIBEL; 406 } else { 407 c->cnr.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 408 } 409 410 /* BER */ 411 if (*status & FE_HAS_LOCK && (c->delivery_system == SYS_DVBT || 412 c->delivery_system == SYS_DVBC_ANNEX_A)) { 413 /* DVB-T & DVB-C BER */ 414 ret = regmap_bulk_read(dev->regmap[0], 0x92, buf, 5); 415 if (ret) 416 goto err; 417 418 utmp1 = buf[0] << 16 | buf[1] << 8 | buf[2] << 0; 419 utmp2 = buf[3] << 8 | buf[4] << 0; 420 utmp2 = utmp2 * 8 * 204; 421 dev_dbg(&client->dev, "post_bit_error=%u post_bit_count=%u\n", 422 utmp1, utmp2); 423 424 c->post_bit_error.stat[0].scale = FE_SCALE_COUNTER; 425 c->post_bit_error.stat[0].uvalue += utmp1; 426 c->post_bit_count.stat[0].scale = FE_SCALE_COUNTER; 427 c->post_bit_count.stat[0].uvalue += utmp2; 428 } else { 429 c->post_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 430 c->post_bit_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 431 } 432 433 /* PER */ 434 if (*status & FE_HAS_LOCK) { 435 ret = regmap_bulk_read(dev->regmap[0], 0xdd, buf, 4); 436 if (ret) 437 goto err; 438 439 utmp1 = buf[0] << 8 | buf[1] << 0; 440 utmp2 = buf[2] << 8 | buf[3] << 0; 441 dev_dbg(&client->dev, "block_error=%u block_count=%u\n", 442 utmp1, utmp2); 443 444 c->block_error.stat[0].scale = FE_SCALE_COUNTER; 445 c->block_error.stat[0].uvalue += utmp1; 446 c->block_count.stat[0].scale = FE_SCALE_COUNTER; 447 c->block_count.stat[0].uvalue += utmp2; 448 } else { 449 c->block_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 450 c->block_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 451 } 452 453 return 0; 454 err: 455 dev_dbg(&client->dev, "failed=%d\n", ret); 456 return ret; 457 } 458 459 static int mn88473_init(struct dvb_frontend *fe) 460 { 461 struct i2c_client *client = fe->demodulator_priv; 462 struct mn88473_dev *dev = i2c_get_clientdata(client); 463 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 464 int ret, len, remain; 465 unsigned int uitmp; 466 const struct firmware *fw; 467 const char *name = MN88473_FIRMWARE; 468 469 dev_dbg(&client->dev, "\n"); 470 471 /* Check if firmware is already running */ 472 ret = regmap_read(dev->regmap[0], 0xf5, &uitmp); 473 if (ret) 474 goto err; 475 476 if (!(uitmp & 0x01)) 477 goto warm; 478 479 /* Request the firmware, this will block and timeout */ 480 ret = request_firmware(&fw, name, &client->dev); 481 if (ret) { 482 dev_err(&client->dev, "firmware file '%s' not found\n", name); 483 goto err; 484 } 485 486 dev_info(&client->dev, "downloading firmware from file '%s'\n", name); 487 488 ret = regmap_write(dev->regmap[0], 0xf5, 0x03); 489 if (ret) 490 goto err_release_firmware; 491 492 for (remain = fw->size; remain > 0; remain -= (dev->i2c_wr_max - 1)) { 493 len = min(dev->i2c_wr_max - 1, remain); 494 ret = regmap_bulk_write(dev->regmap[0], 0xf6, 495 &fw->data[fw->size - remain], len); 496 if (ret) { 497 dev_err(&client->dev, "firmware download failed %d\n", 498 ret); 499 goto err_release_firmware; 500 } 501 } 502 503 release_firmware(fw); 504 505 /* Parity check of firmware */ 506 ret = regmap_read(dev->regmap[0], 0xf8, &uitmp); 507 if (ret) 508 goto err; 509 510 if (uitmp & 0x10) { 511 dev_err(&client->dev, "firmware parity check failed\n"); 512 ret = -EINVAL; 513 goto err; 514 } 515 516 ret = regmap_write(dev->regmap[0], 0xf5, 0x00); 517 if (ret) 518 goto err; 519 warm: 520 /* TS config */ 521 ret = regmap_write(dev->regmap[2], 0x09, 0x08); 522 if (ret) 523 goto err; 524 ret = regmap_write(dev->regmap[2], 0x08, 0x1d); 525 if (ret) 526 goto err; 527 528 dev->active = true; 529 530 /* init stats here to indicate which stats are supported */ 531 c->strength.len = 1; 532 c->strength.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 533 c->cnr.len = 1; 534 c->cnr.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 535 c->post_bit_error.len = 1; 536 c->post_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 537 c->post_bit_count.len = 1; 538 c->post_bit_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 539 c->block_error.len = 1; 540 c->block_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 541 c->block_count.len = 1; 542 c->block_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 543 544 return 0; 545 err_release_firmware: 546 release_firmware(fw); 547 err: 548 dev_dbg(&client->dev, "failed=%d\n", ret); 549 return ret; 550 } 551 552 static int mn88473_sleep(struct dvb_frontend *fe) 553 { 554 struct i2c_client *client = fe->demodulator_priv; 555 struct mn88473_dev *dev = i2c_get_clientdata(client); 556 int ret; 557 558 dev_dbg(&client->dev, "\n"); 559 560 dev->active = false; 561 562 ret = regmap_write(dev->regmap[2], 0x05, 0x3e); 563 if (ret) 564 goto err; 565 566 return 0; 567 err: 568 dev_dbg(&client->dev, "failed=%d\n", ret); 569 return ret; 570 } 571 572 static const struct dvb_frontend_ops mn88473_ops = { 573 .delsys = {SYS_DVBT, SYS_DVBT2, SYS_DVBC_ANNEX_A}, 574 .info = { 575 .name = "Panasonic MN88473", 576 .symbol_rate_min = 1000000, 577 .symbol_rate_max = 7200000, 578 .caps = FE_CAN_FEC_1_2 | 579 FE_CAN_FEC_2_3 | 580 FE_CAN_FEC_3_4 | 581 FE_CAN_FEC_5_6 | 582 FE_CAN_FEC_7_8 | 583 FE_CAN_FEC_AUTO | 584 FE_CAN_QPSK | 585 FE_CAN_QAM_16 | 586 FE_CAN_QAM_32 | 587 FE_CAN_QAM_64 | 588 FE_CAN_QAM_128 | 589 FE_CAN_QAM_256 | 590 FE_CAN_QAM_AUTO | 591 FE_CAN_TRANSMISSION_MODE_AUTO | 592 FE_CAN_GUARD_INTERVAL_AUTO | 593 FE_CAN_HIERARCHY_AUTO | 594 FE_CAN_MUTE_TS | 595 FE_CAN_2G_MODULATION 596 }, 597 598 .get_tune_settings = mn88473_get_tune_settings, 599 600 .init = mn88473_init, 601 .sleep = mn88473_sleep, 602 603 .set_frontend = mn88473_set_frontend, 604 605 .read_status = mn88473_read_status, 606 }; 607 608 static int mn88473_probe(struct i2c_client *client, 609 const struct i2c_device_id *id) 610 { 611 struct mn88473_config *config = client->dev.platform_data; 612 struct mn88473_dev *dev; 613 int ret; 614 unsigned int uitmp; 615 static const struct regmap_config regmap_config = { 616 .reg_bits = 8, 617 .val_bits = 8, 618 }; 619 620 dev_dbg(&client->dev, "\n"); 621 622 /* Caller really need to provide pointer for frontend we create */ 623 if (config->fe == NULL) { 624 dev_err(&client->dev, "frontend pointer not defined\n"); 625 ret = -EINVAL; 626 goto err; 627 } 628 629 dev = kzalloc(sizeof(*dev), GFP_KERNEL); 630 if (dev == NULL) { 631 ret = -ENOMEM; 632 goto err; 633 } 634 635 if (config->i2c_wr_max) 636 dev->i2c_wr_max = config->i2c_wr_max; 637 else 638 dev->i2c_wr_max = ~0; 639 640 if (config->xtal) 641 dev->clk = config->xtal; 642 else 643 dev->clk = 25000000; 644 dev->client[0] = client; 645 dev->regmap[0] = regmap_init_i2c(dev->client[0], ®map_config); 646 if (IS_ERR(dev->regmap[0])) { 647 ret = PTR_ERR(dev->regmap[0]); 648 goto err_kfree; 649 } 650 651 /* 652 * Chip has three I2C addresses for different register banks. Used 653 * addresses are 0x18, 0x1a and 0x1c. We register two dummy clients, 654 * 0x1a and 0x1c, in order to get own I2C client for each register bank. 655 * 656 * Also, register bank 2 do not support sequential I/O. Only single 657 * register write or read is allowed to that bank. 658 */ 659 dev->client[1] = i2c_new_dummy(client->adapter, 0x1a); 660 if (dev->client[1] == NULL) { 661 ret = -ENODEV; 662 dev_err(&client->dev, "I2C registration failed\n"); 663 if (ret) 664 goto err_regmap_0_regmap_exit; 665 } 666 dev->regmap[1] = regmap_init_i2c(dev->client[1], ®map_config); 667 if (IS_ERR(dev->regmap[1])) { 668 ret = PTR_ERR(dev->regmap[1]); 669 goto err_client_1_i2c_unregister_device; 670 } 671 i2c_set_clientdata(dev->client[1], dev); 672 673 dev->client[2] = i2c_new_dummy(client->adapter, 0x1c); 674 if (dev->client[2] == NULL) { 675 ret = -ENODEV; 676 dev_err(&client->dev, "2nd I2C registration failed\n"); 677 if (ret) 678 goto err_regmap_1_regmap_exit; 679 } 680 dev->regmap[2] = regmap_init_i2c(dev->client[2], ®map_config); 681 if (IS_ERR(dev->regmap[2])) { 682 ret = PTR_ERR(dev->regmap[2]); 683 goto err_client_2_i2c_unregister_device; 684 } 685 i2c_set_clientdata(dev->client[2], dev); 686 687 /* Check demod answers with correct chip id */ 688 ret = regmap_read(dev->regmap[2], 0xff, &uitmp); 689 if (ret) 690 goto err_regmap_2_regmap_exit; 691 692 dev_dbg(&client->dev, "chip id=%02x\n", uitmp); 693 694 if (uitmp != 0x03) { 695 ret = -ENODEV; 696 goto err_regmap_2_regmap_exit; 697 } 698 699 /* Sleep because chip is active by default */ 700 ret = regmap_write(dev->regmap[2], 0x05, 0x3e); 701 if (ret) 702 goto err_regmap_2_regmap_exit; 703 704 /* Create dvb frontend */ 705 memcpy(&dev->frontend.ops, &mn88473_ops, sizeof(dev->frontend.ops)); 706 dev->frontend.demodulator_priv = client; 707 *config->fe = &dev->frontend; 708 i2c_set_clientdata(client, dev); 709 710 dev_info(&client->dev, "Panasonic MN88473 successfully identified\n"); 711 712 return 0; 713 err_regmap_2_regmap_exit: 714 regmap_exit(dev->regmap[2]); 715 err_client_2_i2c_unregister_device: 716 i2c_unregister_device(dev->client[2]); 717 err_regmap_1_regmap_exit: 718 regmap_exit(dev->regmap[1]); 719 err_client_1_i2c_unregister_device: 720 i2c_unregister_device(dev->client[1]); 721 err_regmap_0_regmap_exit: 722 regmap_exit(dev->regmap[0]); 723 err_kfree: 724 kfree(dev); 725 err: 726 dev_dbg(&client->dev, "failed=%d\n", ret); 727 return ret; 728 } 729 730 static int mn88473_remove(struct i2c_client *client) 731 { 732 struct mn88473_dev *dev = i2c_get_clientdata(client); 733 734 dev_dbg(&client->dev, "\n"); 735 736 regmap_exit(dev->regmap[2]); 737 i2c_unregister_device(dev->client[2]); 738 739 regmap_exit(dev->regmap[1]); 740 i2c_unregister_device(dev->client[1]); 741 742 regmap_exit(dev->regmap[0]); 743 744 kfree(dev); 745 746 return 0; 747 } 748 749 static const struct i2c_device_id mn88473_id_table[] = { 750 {"mn88473", 0}, 751 {} 752 }; 753 MODULE_DEVICE_TABLE(i2c, mn88473_id_table); 754 755 static struct i2c_driver mn88473_driver = { 756 .driver = { 757 .name = "mn88473", 758 .suppress_bind_attrs = true, 759 }, 760 .probe = mn88473_probe, 761 .remove = mn88473_remove, 762 .id_table = mn88473_id_table, 763 }; 764 765 module_i2c_driver(mn88473_driver); 766 767 MODULE_AUTHOR("Antti Palosaari <crope@iki.fi>"); 768 MODULE_DESCRIPTION("Panasonic MN88473 DVB-T/T2/C demodulator driver"); 769 MODULE_LICENSE("GPL"); 770 MODULE_FIRMWARE(MN88473_FIRMWARE); 771