Akihiro Tsukada | f5d82a7 | 2014-09-08 14:20:42 -0300 | [diff] [blame^] | 1 | /* |
| 2 | * Toshiba TC90522 Demodulator |
| 3 | * |
| 4 | * Copyright (C) 2014 Akihiro Tsukada <tskd08@gmail.com> |
| 5 | * |
| 6 | * This program is free software; you can redistribute it and/or |
| 7 | * modify it under the terms of the GNU General Public License as |
| 8 | * published by the Free Software Foundation version 2. |
| 9 | * |
| 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 | /* |
| 18 | * NOTICE: |
| 19 | * This driver is incomplete and lacks init/config of the chips, |
| 20 | * as the necessary info is not disclosed. |
| 21 | * It assumes that users of this driver (such as a PCI bridge of |
| 22 | * DTV receiver cards) properly init and configure the chip |
| 23 | * via I2C *before* calling this driver's init() function. |
| 24 | * |
| 25 | * Currently, PT3 driver is the only one that uses this driver, |
| 26 | * and contains init/config code in its firmware. |
| 27 | * Thus some part of the code might be dependent on PT3 specific config. |
| 28 | */ |
| 29 | |
| 30 | #include <linux/kernel.h> |
| 31 | #include <linux/dvb/frontend.h> |
| 32 | #include "dvb_math.h" |
| 33 | #include "tc90522.h" |
| 34 | |
| 35 | #define TC90522_I2C_THRU_REG 0xfe |
| 36 | |
| 37 | #define TC90522_MODULE_IDX(addr) (((u8)(addr) & 0x02U) >> 1) |
| 38 | |
| 39 | struct tc90522_state { |
| 40 | struct tc90522_config cfg; |
| 41 | struct dvb_frontend fe; |
| 42 | struct i2c_client *i2c_client; |
| 43 | struct i2c_adapter tuner_i2c; |
| 44 | |
| 45 | bool lna; |
| 46 | }; |
| 47 | |
| 48 | struct reg_val { |
| 49 | u8 reg; |
| 50 | u8 val; |
| 51 | }; |
| 52 | |
| 53 | static int |
| 54 | reg_write(struct tc90522_state *state, const struct reg_val *regs, int num) |
| 55 | { |
| 56 | int i, ret; |
| 57 | struct i2c_msg msg; |
| 58 | |
| 59 | ret = 0; |
| 60 | msg.addr = state->i2c_client->addr; |
| 61 | msg.flags = 0; |
| 62 | msg.len = 2; |
| 63 | for (i = 0; i < num; i++) { |
| 64 | msg.buf = (u8 *)®s[i]; |
| 65 | ret = i2c_transfer(state->i2c_client->adapter, &msg, 1); |
| 66 | if (ret == 0) |
| 67 | ret = -EIO; |
| 68 | if (ret < 0) |
| 69 | return ret; |
| 70 | } |
| 71 | return 0; |
| 72 | } |
| 73 | |
| 74 | static int reg_read(struct tc90522_state *state, u8 reg, u8 *val, u8 len) |
| 75 | { |
| 76 | struct i2c_msg msgs[2] = { |
| 77 | { |
| 78 | .addr = state->i2c_client->addr, |
| 79 | .flags = 0, |
| 80 | .buf = ®, |
| 81 | .len = 1, |
| 82 | }, |
| 83 | { |
| 84 | .addr = state->i2c_client->addr, |
| 85 | .flags = I2C_M_RD, |
| 86 | .buf = val, |
| 87 | .len = len, |
| 88 | }, |
| 89 | }; |
| 90 | int ret; |
| 91 | |
| 92 | ret = i2c_transfer(state->i2c_client->adapter, msgs, ARRAY_SIZE(msgs)); |
| 93 | if (ret == ARRAY_SIZE(msgs)) |
| 94 | ret = 0; |
| 95 | else if (ret >= 0) |
| 96 | ret = -EIO; |
| 97 | return ret; |
| 98 | } |
| 99 | |
| 100 | static struct tc90522_state *cfg_to_state(struct tc90522_config *c) |
| 101 | { |
| 102 | return container_of(c, struct tc90522_state, cfg); |
| 103 | } |
| 104 | |
| 105 | |
| 106 | static int tc90522s_set_tsid(struct dvb_frontend *fe) |
| 107 | { |
| 108 | struct reg_val set_tsid[] = { |
| 109 | { 0x8f, 00 }, |
| 110 | { 0x90, 00 } |
| 111 | }; |
| 112 | |
| 113 | set_tsid[0].val = (fe->dtv_property_cache.stream_id & 0xff00) >> 8; |
| 114 | set_tsid[1].val = fe->dtv_property_cache.stream_id & 0xff; |
| 115 | return reg_write(fe->demodulator_priv, set_tsid, ARRAY_SIZE(set_tsid)); |
| 116 | } |
| 117 | |
| 118 | static int tc90522t_set_layers(struct dvb_frontend *fe) |
| 119 | { |
| 120 | struct reg_val rv; |
| 121 | u8 laysel; |
| 122 | |
| 123 | laysel = ~fe->dtv_property_cache.isdbt_layer_enabled & 0x07; |
| 124 | laysel = (laysel & 0x01) << 2 | (laysel & 0x02) | (laysel & 0x04) >> 2; |
| 125 | rv.reg = 0x71; |
| 126 | rv.val = laysel; |
| 127 | return reg_write(fe->demodulator_priv, &rv, 1); |
| 128 | } |
| 129 | |
| 130 | /* frontend ops */ |
| 131 | |
| 132 | static int tc90522s_read_status(struct dvb_frontend *fe, fe_status_t *status) |
| 133 | { |
| 134 | struct tc90522_state *state; |
| 135 | int ret; |
| 136 | u8 reg; |
| 137 | |
| 138 | state = fe->demodulator_priv; |
| 139 | ret = reg_read(state, 0xc3, ®, 1); |
| 140 | if (ret < 0) |
| 141 | return ret; |
| 142 | |
| 143 | *status = 0; |
| 144 | if (reg & 0x80) /* input level under min ? */ |
| 145 | return 0; |
| 146 | *status |= FE_HAS_SIGNAL; |
| 147 | |
| 148 | if (reg & 0x60) /* carrier? */ |
| 149 | return 0; |
| 150 | *status |= FE_HAS_CARRIER | FE_HAS_VITERBI | FE_HAS_SYNC; |
| 151 | |
| 152 | if (reg & 0x10) |
| 153 | return 0; |
| 154 | if (reg_read(state, 0xc5, ®, 1) < 0 || !(reg & 0x03)) |
| 155 | return 0; |
| 156 | *status |= FE_HAS_LOCK; |
| 157 | return 0; |
| 158 | } |
| 159 | |
| 160 | static int tc90522t_read_status(struct dvb_frontend *fe, fe_status_t *status) |
| 161 | { |
| 162 | struct tc90522_state *state; |
| 163 | int ret; |
| 164 | u8 reg; |
| 165 | |
| 166 | state = fe->demodulator_priv; |
| 167 | ret = reg_read(state, 0x96, ®, 1); |
| 168 | if (ret < 0) |
| 169 | return ret; |
| 170 | |
| 171 | *status = 0; |
| 172 | if (reg & 0xe0) { |
| 173 | *status = FE_HAS_SIGNAL | FE_HAS_CARRIER | FE_HAS_VITERBI |
| 174 | | FE_HAS_SYNC | FE_HAS_LOCK; |
| 175 | return 0; |
| 176 | } |
| 177 | |
| 178 | ret = reg_read(state, 0x80, ®, 1); |
| 179 | if (ret < 0) |
| 180 | return ret; |
| 181 | |
| 182 | if (reg & 0xf0) |
| 183 | return 0; |
| 184 | *status |= FE_HAS_SIGNAL | FE_HAS_CARRIER; |
| 185 | |
| 186 | if (reg & 0x0c) |
| 187 | return 0; |
| 188 | *status |= FE_HAS_SYNC | FE_HAS_VITERBI; |
| 189 | |
| 190 | if (reg & 0x02) |
| 191 | return 0; |
| 192 | *status |= FE_HAS_LOCK; |
| 193 | return 0; |
| 194 | } |
| 195 | |
| 196 | static const fe_code_rate_t fec_conv_sat[] = { |
| 197 | FEC_NONE, /* unused */ |
| 198 | FEC_1_2, /* for BPSK */ |
| 199 | FEC_1_2, FEC_2_3, FEC_3_4, FEC_5_6, FEC_7_8, /* for QPSK */ |
| 200 | FEC_2_3, /* for 8PSK. (trellis code) */ |
| 201 | }; |
| 202 | |
| 203 | static int tc90522s_get_frontend(struct dvb_frontend *fe) |
| 204 | { |
| 205 | struct tc90522_state *state; |
| 206 | struct dtv_frontend_properties *c; |
| 207 | struct dtv_fe_stats *stats; |
| 208 | int ret, i; |
| 209 | int layers; |
| 210 | u8 val[10]; |
| 211 | u32 cndat; |
| 212 | |
| 213 | state = fe->demodulator_priv; |
| 214 | c = &fe->dtv_property_cache; |
| 215 | c->delivery_system = SYS_ISDBS; |
| 216 | |
| 217 | layers = 0; |
| 218 | ret = reg_read(state, 0xe8, val, 3); |
| 219 | if (ret == 0) { |
| 220 | int slots; |
| 221 | u8 v; |
| 222 | |
| 223 | /* high/single layer */ |
| 224 | v = (val[0] & 0x70) >> 4; |
| 225 | c->modulation = (v == 7) ? PSK_8 : QPSK; |
| 226 | c->fec_inner = fec_conv_sat[v]; |
| 227 | c->layer[0].fec = c->fec_inner; |
| 228 | c->layer[0].modulation = c->modulation; |
| 229 | c->layer[0].segment_count = val[1] & 0x3f; /* slots */ |
| 230 | |
| 231 | /* low layer */ |
| 232 | v = (val[0] & 0x07); |
| 233 | c->layer[1].fec = fec_conv_sat[v]; |
| 234 | if (v == 0) /* no low layer */ |
| 235 | c->layer[1].segment_count = 0; |
| 236 | else |
| 237 | c->layer[1].segment_count = val[2] & 0x3f; /* slots */ |
| 238 | /* actually, BPSK if v==1, but not defined in fe_modulation_t */ |
| 239 | c->layer[1].modulation = QPSK; |
| 240 | layers = (v > 0) ? 2 : 1; |
| 241 | |
| 242 | slots = c->layer[0].segment_count + c->layer[1].segment_count; |
| 243 | c->symbol_rate = 28860000 * slots / 48; |
| 244 | } |
| 245 | |
| 246 | /* statistics */ |
| 247 | |
| 248 | stats = &c->strength; |
| 249 | stats->len = 0; |
| 250 | /* let the connected tuner set RSSI property cache */ |
| 251 | if (fe->ops.tuner_ops.get_rf_strength) { |
| 252 | u16 dummy; |
| 253 | |
| 254 | fe->ops.tuner_ops.get_rf_strength(fe, &dummy); |
| 255 | } |
| 256 | |
| 257 | stats = &c->cnr; |
| 258 | stats->len = 1; |
| 259 | stats->stat[0].scale = FE_SCALE_NOT_AVAILABLE; |
| 260 | cndat = 0; |
| 261 | ret = reg_read(state, 0xbc, val, 2); |
| 262 | if (ret == 0) |
| 263 | cndat = val[0] << 8 | val[1]; |
| 264 | if (cndat >= 3000) { |
| 265 | u32 p, p4; |
| 266 | s64 cn; |
| 267 | |
| 268 | cndat -= 3000; /* cndat: 4.12 fixed point float */ |
| 269 | /* |
| 270 | * cnr[mdB] = -1634.6 * P^5 + 14341 * P^4 - 50259 * P^3 |
| 271 | * + 88977 * P^2 - 89565 * P + 58857 |
| 272 | * (P = sqrt(cndat) / 64) |
| 273 | */ |
| 274 | /* p := sqrt(cndat) << 8 = P << 14, 2.14 fixed point float */ |
| 275 | /* cn = cnr << 3 */ |
| 276 | p = int_sqrt(cndat << 16); |
| 277 | p4 = cndat * cndat; |
| 278 | cn = (-16346LL * p4 * p / 10) >> 35; |
| 279 | cn += (14341LL * p4) >> 21; |
| 280 | cn -= (50259LL * cndat * p) >> 23; |
| 281 | cn += (88977LL * cndat) >> 9; |
| 282 | cn -= (89565LL * p) >> 11; |
| 283 | cn += 58857 << 3; |
| 284 | stats->stat[0].svalue = cn >> 3; |
| 285 | stats->stat[0].scale = FE_SCALE_DECIBEL; |
| 286 | } |
| 287 | |
| 288 | /* per-layer post viterbi BER (or PER? config dependent?) */ |
| 289 | stats = &c->post_bit_error; |
| 290 | memset(stats, 0, sizeof(*stats)); |
| 291 | stats->len = layers; |
| 292 | ret = reg_read(state, 0xeb, val, 10); |
| 293 | if (ret < 0) |
| 294 | for (i = 0; i < layers; i++) |
| 295 | stats->stat[i].scale = FE_SCALE_NOT_AVAILABLE; |
| 296 | else { |
| 297 | for (i = 0; i < layers; i++) { |
| 298 | stats->stat[i].scale = FE_SCALE_COUNTER; |
| 299 | stats->stat[i].uvalue = val[i * 5] << 16 |
| 300 | | val[i * 5 + 1] << 8 | val[i * 5 + 2]; |
| 301 | } |
| 302 | } |
| 303 | stats = &c->post_bit_count; |
| 304 | memset(stats, 0, sizeof(*stats)); |
| 305 | stats->len = layers; |
| 306 | if (ret < 0) |
| 307 | for (i = 0; i < layers; i++) |
| 308 | stats->stat[i].scale = FE_SCALE_NOT_AVAILABLE; |
| 309 | else { |
| 310 | for (i = 0; i < layers; i++) { |
| 311 | stats->stat[i].scale = FE_SCALE_COUNTER; |
| 312 | stats->stat[i].uvalue = |
| 313 | val[i * 5 + 3] << 8 | val[i * 5 + 4]; |
| 314 | stats->stat[i].uvalue *= 204 * 8; |
| 315 | } |
| 316 | } |
| 317 | |
| 318 | return 0; |
| 319 | } |
| 320 | |
| 321 | |
| 322 | static const fe_transmit_mode_t tm_conv[] = { |
| 323 | TRANSMISSION_MODE_2K, |
| 324 | TRANSMISSION_MODE_4K, |
| 325 | TRANSMISSION_MODE_8K, |
| 326 | 0 |
| 327 | }; |
| 328 | |
| 329 | static const fe_code_rate_t fec_conv_ter[] = { |
| 330 | FEC_1_2, FEC_2_3, FEC_3_4, FEC_5_6, FEC_7_8, 0, 0, 0 |
| 331 | }; |
| 332 | |
| 333 | static const fe_modulation_t mod_conv[] = { |
| 334 | DQPSK, QPSK, QAM_16, QAM_64, 0, 0, 0, 0 |
| 335 | }; |
| 336 | |
| 337 | static int tc90522t_get_frontend(struct dvb_frontend *fe) |
| 338 | { |
| 339 | struct tc90522_state *state; |
| 340 | struct dtv_frontend_properties *c; |
| 341 | struct dtv_fe_stats *stats; |
| 342 | int ret, i; |
| 343 | int layers; |
| 344 | u8 val[15], mode; |
| 345 | u32 cndat; |
| 346 | |
| 347 | state = fe->demodulator_priv; |
| 348 | c = &fe->dtv_property_cache; |
| 349 | c->delivery_system = SYS_ISDBT; |
| 350 | c->bandwidth_hz = 6000000; |
| 351 | mode = 1; |
| 352 | ret = reg_read(state, 0xb0, val, 1); |
| 353 | if (ret == 0) { |
| 354 | mode = (val[0] & 0xc0) >> 2; |
| 355 | c->transmission_mode = tm_conv[mode]; |
| 356 | c->guard_interval = (val[0] & 0x30) >> 4; |
| 357 | } |
| 358 | |
| 359 | ret = reg_read(state, 0xb2, val, 6); |
| 360 | layers = 0; |
| 361 | if (ret == 0) { |
| 362 | u8 v; |
| 363 | |
| 364 | c->isdbt_partial_reception = val[0] & 0x01; |
| 365 | c->isdbt_sb_mode = (val[0] & 0xc0) == 0x01; |
| 366 | |
| 367 | /* layer A */ |
| 368 | v = (val[2] & 0x78) >> 3; |
| 369 | if (v == 0x0f) |
| 370 | c->layer[0].segment_count = 0; |
| 371 | else { |
| 372 | layers++; |
| 373 | c->layer[0].segment_count = v; |
| 374 | c->layer[0].fec = fec_conv_ter[(val[1] & 0x1c) >> 2]; |
| 375 | c->layer[0].modulation = mod_conv[(val[1] & 0xe0) >> 5]; |
| 376 | v = (val[1] & 0x03) << 1 | (val[2] & 0x80) >> 7; |
| 377 | c->layer[0].interleaving = v; |
| 378 | } |
| 379 | |
| 380 | /* layer B */ |
| 381 | v = (val[3] & 0x03) << 1 | (val[4] & 0xc0) >> 6; |
| 382 | if (v == 0x0f) |
| 383 | c->layer[1].segment_count = 0; |
| 384 | else { |
| 385 | layers++; |
| 386 | c->layer[1].segment_count = v; |
| 387 | c->layer[1].fec = fec_conv_ter[(val[3] & 0xe0) >> 5]; |
| 388 | c->layer[1].modulation = mod_conv[(val[2] & 0x07)]; |
| 389 | c->layer[1].interleaving = (val[3] & 0x1c) >> 2; |
| 390 | } |
| 391 | |
| 392 | /* layer C */ |
| 393 | v = (val[5] & 0x1e) >> 1; |
| 394 | if (v == 0x0f) |
| 395 | c->layer[2].segment_count = 0; |
| 396 | else { |
| 397 | layers++; |
| 398 | c->layer[2].segment_count = v; |
| 399 | c->layer[2].fec = fec_conv_ter[(val[4] & 0x07)]; |
| 400 | c->layer[2].modulation = mod_conv[(val[4] & 0x38) >> 3]; |
| 401 | c->layer[2].interleaving = (val[5] & 0xe0) >> 5; |
| 402 | } |
| 403 | } |
| 404 | |
| 405 | /* statistics */ |
| 406 | |
| 407 | stats = &c->strength; |
| 408 | stats->len = 0; |
| 409 | /* let the connected tuner set RSSI property cache */ |
| 410 | if (fe->ops.tuner_ops.get_rf_strength) { |
| 411 | u16 dummy; |
| 412 | |
| 413 | fe->ops.tuner_ops.get_rf_strength(fe, &dummy); |
| 414 | } |
| 415 | |
| 416 | stats = &c->cnr; |
| 417 | stats->len = 1; |
| 418 | stats->stat[0].scale = FE_SCALE_NOT_AVAILABLE; |
| 419 | cndat = 0; |
| 420 | ret = reg_read(state, 0x8b, val, 3); |
| 421 | if (ret == 0) |
| 422 | cndat = val[0] << 16 | val[1] << 8 | val[2]; |
| 423 | if (cndat != 0) { |
| 424 | u32 p, tmp; |
| 425 | s64 cn; |
| 426 | |
| 427 | /* |
| 428 | * cnr[mdB] = 0.024 P^4 - 1.6 P^3 + 39.8 P^2 + 549.1 P + 3096.5 |
| 429 | * (P = 10log10(5505024/cndat)) |
| 430 | */ |
| 431 | /* cn = cnr << 3 (61.3 fixed point float */ |
| 432 | /* p = 10log10(5505024/cndat) << 24 (8.24 fixed point float)*/ |
| 433 | p = intlog10(5505024) - intlog10(cndat); |
| 434 | p *= 10; |
| 435 | |
| 436 | cn = 24772; |
| 437 | cn += ((43827LL * p) / 10) >> 24; |
| 438 | tmp = p >> 8; |
| 439 | cn += ((3184LL * tmp * tmp) / 10) >> 32; |
| 440 | tmp = p >> 13; |
| 441 | cn -= ((128LL * tmp * tmp * tmp) / 10) >> 33; |
| 442 | tmp = p >> 18; |
| 443 | cn += ((192LL * tmp * tmp * tmp * tmp) / 1000) >> 24; |
| 444 | |
| 445 | stats->stat[0].svalue = cn >> 3; |
| 446 | stats->stat[0].scale = FE_SCALE_DECIBEL; |
| 447 | } |
| 448 | |
| 449 | /* per-layer post viterbi BER (or PER? config dependent?) */ |
| 450 | stats = &c->post_bit_error; |
| 451 | memset(stats, 0, sizeof(*stats)); |
| 452 | stats->len = layers; |
| 453 | ret = reg_read(state, 0x9d, val, 15); |
| 454 | if (ret < 0) |
| 455 | for (i = 0; i < layers; i++) |
| 456 | stats->stat[i].scale = FE_SCALE_NOT_AVAILABLE; |
| 457 | else { |
| 458 | for (i = 0; i < layers; i++) { |
| 459 | stats->stat[i].scale = FE_SCALE_COUNTER; |
| 460 | stats->stat[i].uvalue = val[i * 3] << 16 |
| 461 | | val[i * 3 + 1] << 8 | val[i * 3 + 2]; |
| 462 | } |
| 463 | } |
| 464 | stats = &c->post_bit_count; |
| 465 | memset(stats, 0, sizeof(*stats)); |
| 466 | stats->len = layers; |
| 467 | if (ret < 0) |
| 468 | for (i = 0; i < layers; i++) |
| 469 | stats->stat[i].scale = FE_SCALE_NOT_AVAILABLE; |
| 470 | else { |
| 471 | for (i = 0; i < layers; i++) { |
| 472 | stats->stat[i].scale = FE_SCALE_COUNTER; |
| 473 | stats->stat[i].uvalue = |
| 474 | val[9 + i * 2] << 8 | val[9 + i * 2 + 1]; |
| 475 | stats->stat[i].uvalue *= 204 * 8; |
| 476 | } |
| 477 | } |
| 478 | |
| 479 | return 0; |
| 480 | } |
| 481 | |
| 482 | static const struct reg_val reset_sat = { 0x03, 0x01 }; |
| 483 | static const struct reg_val reset_ter = { 0x01, 0x40 }; |
| 484 | |
| 485 | static int tc90522_set_frontend(struct dvb_frontend *fe) |
| 486 | { |
| 487 | struct tc90522_state *state; |
| 488 | int ret; |
| 489 | |
| 490 | state = fe->demodulator_priv; |
| 491 | |
| 492 | if (fe->ops.tuner_ops.set_params) |
| 493 | ret = fe->ops.tuner_ops.set_params(fe); |
| 494 | else |
| 495 | ret = -ENODEV; |
| 496 | if (ret < 0) |
| 497 | goto failed; |
| 498 | |
| 499 | if (fe->ops.delsys[0] == SYS_ISDBS) { |
| 500 | ret = tc90522s_set_tsid(fe); |
| 501 | if (ret < 0) |
| 502 | goto failed; |
| 503 | ret = reg_write(state, &reset_sat, 1); |
| 504 | } else { |
| 505 | ret = tc90522t_set_layers(fe); |
| 506 | if (ret < 0) |
| 507 | goto failed; |
| 508 | ret = reg_write(state, &reset_ter, 1); |
| 509 | } |
| 510 | if (ret < 0) |
| 511 | goto failed; |
| 512 | |
| 513 | return 0; |
| 514 | |
| 515 | failed: |
| 516 | dev_warn(&state->tuner_i2c.dev, "(%s) failed. [adap%d-fe%d]\n", |
| 517 | __func__, fe->dvb->num, fe->id); |
| 518 | return ret; |
| 519 | } |
| 520 | |
| 521 | static int tc90522_get_tune_settings(struct dvb_frontend *fe, |
| 522 | struct dvb_frontend_tune_settings *settings) |
| 523 | { |
| 524 | if (fe->ops.delsys[0] == SYS_ISDBS) { |
| 525 | settings->min_delay_ms = 250; |
| 526 | settings->step_size = 1000; |
| 527 | settings->max_drift = settings->step_size * 2; |
| 528 | } else { |
| 529 | settings->min_delay_ms = 400; |
| 530 | settings->step_size = 142857; |
| 531 | settings->max_drift = settings->step_size; |
| 532 | } |
| 533 | return 0; |
| 534 | } |
| 535 | |
| 536 | static int tc90522_set_if_agc(struct dvb_frontend *fe, bool on) |
| 537 | { |
| 538 | struct reg_val agc_sat[] = { |
| 539 | { 0x0a, 0x00 }, |
| 540 | { 0x10, 0x30 }, |
| 541 | { 0x11, 0x00 }, |
| 542 | { 0x03, 0x01 }, |
| 543 | }; |
| 544 | struct reg_val agc_ter[] = { |
| 545 | { 0x25, 0x00 }, |
| 546 | { 0x23, 0x4c }, |
| 547 | { 0x01, 0x40 }, |
| 548 | }; |
| 549 | struct tc90522_state *state; |
| 550 | struct reg_val *rv; |
| 551 | int num; |
| 552 | |
| 553 | state = fe->demodulator_priv; |
| 554 | if (fe->ops.delsys[0] == SYS_ISDBS) { |
| 555 | agc_sat[0].val = on ? 0xff : 0x00; |
| 556 | agc_sat[1].val |= 0x80; |
| 557 | agc_sat[1].val |= on ? 0x01 : 0x00; |
| 558 | agc_sat[2].val |= on ? 0x40 : 0x00; |
| 559 | rv = agc_sat; |
| 560 | num = ARRAY_SIZE(agc_sat); |
| 561 | } else { |
| 562 | agc_ter[0].val = on ? 0x40 : 0x00; |
| 563 | agc_ter[1].val |= on ? 0x00 : 0x01; |
| 564 | rv = agc_ter; |
| 565 | num = ARRAY_SIZE(agc_ter); |
| 566 | } |
| 567 | return reg_write(state, rv, num); |
| 568 | } |
| 569 | |
| 570 | static const struct reg_val sleep_sat = { 0x17, 0x01 }; |
| 571 | static const struct reg_val sleep_ter = { 0x03, 0x90 }; |
| 572 | |
| 573 | static int tc90522_sleep(struct dvb_frontend *fe) |
| 574 | { |
| 575 | struct tc90522_state *state; |
| 576 | int ret; |
| 577 | |
| 578 | state = fe->demodulator_priv; |
| 579 | if (fe->ops.delsys[0] == SYS_ISDBS) |
| 580 | ret = reg_write(state, &sleep_sat, 1); |
| 581 | else { |
| 582 | ret = reg_write(state, &sleep_ter, 1); |
| 583 | if (ret == 0 && fe->ops.set_lna && |
| 584 | fe->dtv_property_cache.lna == LNA_AUTO) { |
| 585 | fe->dtv_property_cache.lna = 0; |
| 586 | ret = fe->ops.set_lna(fe); |
| 587 | fe->dtv_property_cache.lna = LNA_AUTO; |
| 588 | } |
| 589 | } |
| 590 | if (ret < 0) |
| 591 | dev_warn(&state->tuner_i2c.dev, |
| 592 | "(%s) failed. [adap%d-fe%d]\n", |
| 593 | __func__, fe->dvb->num, fe->id); |
| 594 | return ret; |
| 595 | } |
| 596 | |
| 597 | static const struct reg_val wakeup_sat = { 0x17, 0x00 }; |
| 598 | static const struct reg_val wakeup_ter = { 0x03, 0x80 }; |
| 599 | |
| 600 | static int tc90522_init(struct dvb_frontend *fe) |
| 601 | { |
| 602 | struct tc90522_state *state; |
| 603 | int ret; |
| 604 | |
| 605 | /* |
| 606 | * Because the init sequence is not public, |
| 607 | * the parent device/driver should have init'ed the device before. |
| 608 | * just wake up the device here. |
| 609 | */ |
| 610 | |
| 611 | state = fe->demodulator_priv; |
| 612 | if (fe->ops.delsys[0] == SYS_ISDBS) |
| 613 | ret = reg_write(state, &wakeup_sat, 1); |
| 614 | else { |
| 615 | ret = reg_write(state, &wakeup_ter, 1); |
| 616 | if (ret == 0 && fe->ops.set_lna && |
| 617 | fe->dtv_property_cache.lna == LNA_AUTO) { |
| 618 | fe->dtv_property_cache.lna = 1; |
| 619 | ret = fe->ops.set_lna(fe); |
| 620 | fe->dtv_property_cache.lna = LNA_AUTO; |
| 621 | } |
| 622 | } |
| 623 | if (ret < 0) { |
| 624 | dev_warn(&state->tuner_i2c.dev, |
| 625 | "(%s) failed. [adap%d-fe%d]\n", |
| 626 | __func__, fe->dvb->num, fe->id); |
| 627 | return ret; |
| 628 | } |
| 629 | |
| 630 | /* prefer 'all-layers' to 'none' as a default */ |
| 631 | if (fe->dtv_property_cache.isdbt_layer_enabled == 0) |
| 632 | fe->dtv_property_cache.isdbt_layer_enabled = 7; |
| 633 | return tc90522_set_if_agc(fe, true); |
| 634 | } |
| 635 | |
| 636 | |
| 637 | /* |
| 638 | * tuner I2C adapter functions |
| 639 | */ |
| 640 | |
| 641 | static int |
| 642 | tc90522_master_xfer(struct i2c_adapter *adap, struct i2c_msg *msgs, int num) |
| 643 | { |
| 644 | struct tc90522_state *state; |
| 645 | struct i2c_msg *new_msgs; |
| 646 | int i, j; |
| 647 | int ret, rd_num; |
| 648 | u8 wbuf[256]; |
| 649 | u8 *p, *bufend; |
| 650 | |
| 651 | if (num <= 0) |
| 652 | return -EINVAL; |
| 653 | |
| 654 | rd_num = 0; |
| 655 | for (i = 0; i < num; i++) |
| 656 | if (msgs[i].flags & I2C_M_RD) |
| 657 | rd_num++; |
| 658 | new_msgs = kmalloc(sizeof(*new_msgs) * (num + rd_num), GFP_KERNEL); |
| 659 | if (!new_msgs) |
| 660 | return -ENOMEM; |
| 661 | |
| 662 | state = i2c_get_adapdata(adap); |
| 663 | p = wbuf; |
| 664 | bufend = wbuf + sizeof(wbuf); |
| 665 | for (i = 0, j = 0; i < num; i++, j++) { |
| 666 | new_msgs[j].addr = state->i2c_client->addr; |
| 667 | new_msgs[j].flags = msgs[i].flags; |
| 668 | |
| 669 | if (msgs[i].flags & I2C_M_RD) { |
| 670 | new_msgs[j].flags &= ~I2C_M_RD; |
| 671 | if (p + 2 > bufend) |
| 672 | break; |
| 673 | p[0] = TC90522_I2C_THRU_REG; |
| 674 | p[1] = msgs[i].addr << 1 | 0x01; |
| 675 | new_msgs[j].buf = p; |
| 676 | new_msgs[j].len = 2; |
| 677 | p += 2; |
| 678 | j++; |
| 679 | new_msgs[j].addr = state->i2c_client->addr; |
| 680 | new_msgs[j].flags = msgs[i].flags; |
| 681 | new_msgs[j].buf = msgs[i].buf; |
| 682 | new_msgs[j].len = msgs[i].len; |
| 683 | continue; |
| 684 | } |
| 685 | |
| 686 | if (p + msgs[i].len + 2 > bufend) |
| 687 | break; |
| 688 | p[0] = TC90522_I2C_THRU_REG; |
| 689 | p[1] = msgs[i].addr << 1; |
| 690 | memcpy(p + 2, msgs[i].buf, msgs[i].len); |
| 691 | new_msgs[j].buf = p; |
| 692 | new_msgs[j].len = msgs[i].len + 2; |
| 693 | p += new_msgs[j].len; |
| 694 | } |
| 695 | |
| 696 | if (i < num) |
| 697 | ret = -ENOMEM; |
| 698 | else |
| 699 | ret = i2c_transfer(state->i2c_client->adapter, new_msgs, j); |
| 700 | if (ret >= 0 && ret < j) |
| 701 | ret = -EIO; |
| 702 | kfree(new_msgs); |
| 703 | return (ret == j) ? num : ret; |
| 704 | } |
| 705 | |
| 706 | u32 tc90522_functionality(struct i2c_adapter *adap) |
| 707 | { |
| 708 | return I2C_FUNC_I2C; |
| 709 | } |
| 710 | |
| 711 | static const struct i2c_algorithm tc90522_tuner_i2c_algo = { |
| 712 | .master_xfer = &tc90522_master_xfer, |
| 713 | .functionality = &tc90522_functionality, |
| 714 | }; |
| 715 | |
| 716 | |
| 717 | /* |
| 718 | * I2C driver functions |
| 719 | */ |
| 720 | |
| 721 | static const struct dvb_frontend_ops tc90522_ops_sat = { |
| 722 | .delsys = { SYS_ISDBS }, |
| 723 | .info = { |
| 724 | .name = "Toshiba TC90522 ISDB-S module", |
| 725 | .frequency_min = 950000, |
| 726 | .frequency_max = 2150000, |
| 727 | .caps = FE_CAN_INVERSION_AUTO | FE_CAN_FEC_AUTO | |
| 728 | FE_CAN_QAM_AUTO | FE_CAN_TRANSMISSION_MODE_AUTO | |
| 729 | FE_CAN_GUARD_INTERVAL_AUTO | FE_CAN_HIERARCHY_AUTO, |
| 730 | }, |
| 731 | |
| 732 | .init = tc90522_init, |
| 733 | .sleep = tc90522_sleep, |
| 734 | .set_frontend = tc90522_set_frontend, |
| 735 | .get_tune_settings = tc90522_get_tune_settings, |
| 736 | |
| 737 | .get_frontend = tc90522s_get_frontend, |
| 738 | .read_status = tc90522s_read_status, |
| 739 | }; |
| 740 | |
| 741 | static const struct dvb_frontend_ops tc90522_ops_ter = { |
| 742 | .delsys = { SYS_ISDBT }, |
| 743 | .info = { |
| 744 | .name = "Toshiba TC90522 ISDB-T module", |
| 745 | .frequency_min = 470000000, |
| 746 | .frequency_max = 770000000, |
| 747 | .frequency_stepsize = 142857, |
| 748 | .caps = FE_CAN_INVERSION_AUTO | |
| 749 | FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 | FE_CAN_FEC_3_4 | |
| 750 | FE_CAN_FEC_5_6 | FE_CAN_FEC_7_8 | FE_CAN_FEC_AUTO | |
| 751 | FE_CAN_QPSK | FE_CAN_QAM_16 | FE_CAN_QAM_64 | |
| 752 | FE_CAN_QAM_AUTO | FE_CAN_TRANSMISSION_MODE_AUTO | |
| 753 | FE_CAN_GUARD_INTERVAL_AUTO | FE_CAN_RECOVER | |
| 754 | FE_CAN_HIERARCHY_AUTO, |
| 755 | }, |
| 756 | |
| 757 | .init = tc90522_init, |
| 758 | .sleep = tc90522_sleep, |
| 759 | .set_frontend = tc90522_set_frontend, |
| 760 | .get_tune_settings = tc90522_get_tune_settings, |
| 761 | |
| 762 | .get_frontend = tc90522t_get_frontend, |
| 763 | .read_status = tc90522t_read_status, |
| 764 | }; |
| 765 | |
| 766 | |
| 767 | static int tc90522_probe(struct i2c_client *client, |
| 768 | const struct i2c_device_id *id) |
| 769 | { |
| 770 | struct tc90522_state *state; |
| 771 | struct tc90522_config *cfg; |
| 772 | const struct dvb_frontend_ops *ops; |
| 773 | struct i2c_adapter *adap; |
| 774 | int ret; |
| 775 | |
| 776 | state = kzalloc(sizeof(*state), GFP_KERNEL); |
| 777 | if (!state) |
| 778 | return -ENOMEM; |
| 779 | state->i2c_client = client; |
| 780 | |
| 781 | cfg = client->dev.platform_data; |
| 782 | memcpy(&state->cfg, cfg, sizeof(state->cfg)); |
| 783 | cfg->fe = state->cfg.fe = &state->fe; |
| 784 | ops = id->driver_data == 0 ? &tc90522_ops_sat : &tc90522_ops_ter; |
| 785 | memcpy(&state->fe.ops, ops, sizeof(*ops)); |
| 786 | state->fe.demodulator_priv = state; |
| 787 | |
| 788 | adap = &state->tuner_i2c; |
| 789 | adap->owner = THIS_MODULE; |
| 790 | adap->algo = &tc90522_tuner_i2c_algo; |
| 791 | adap->dev.parent = &client->dev; |
| 792 | strlcpy(adap->name, "tc90522_sub", sizeof(adap->name)); |
| 793 | i2c_set_adapdata(adap, state); |
| 794 | ret = i2c_add_adapter(adap); |
| 795 | if (ret < 0) |
| 796 | goto err; |
| 797 | cfg->tuner_i2c = state->cfg.tuner_i2c = adap; |
| 798 | |
| 799 | i2c_set_clientdata(client, &state->cfg); |
| 800 | dev_info(&client->dev, "Toshiba TC90522 attached.\n"); |
| 801 | return 0; |
| 802 | |
| 803 | err: |
| 804 | kfree(state); |
| 805 | return ret; |
| 806 | } |
| 807 | |
| 808 | static int tc90522_remove(struct i2c_client *client) |
| 809 | { |
| 810 | struct tc90522_state *state; |
| 811 | |
| 812 | state = cfg_to_state(i2c_get_clientdata(client)); |
| 813 | i2c_del_adapter(&state->tuner_i2c); |
| 814 | kfree(state); |
| 815 | return 0; |
| 816 | } |
| 817 | |
| 818 | |
| 819 | static const struct i2c_device_id tc90522_id[] = { |
| 820 | { TC90522_I2C_DEV_SAT, 0 }, |
| 821 | { TC90522_I2C_DEV_TER, 1 }, |
| 822 | {} |
| 823 | }; |
| 824 | MODULE_DEVICE_TABLE(i2c, tc90522_id); |
| 825 | |
| 826 | static struct i2c_driver tc90522_driver = { |
| 827 | .driver = { |
| 828 | .name = "tc90522", |
| 829 | }, |
| 830 | .probe = tc90522_probe, |
| 831 | .remove = tc90522_remove, |
| 832 | .id_table = tc90522_id, |
| 833 | }; |
| 834 | |
| 835 | module_i2c_driver(tc90522_driver); |
| 836 | |
| 837 | MODULE_DESCRIPTION("Toshiba TC90522 frontend"); |
| 838 | MODULE_AUTHOR("Akihiro TSUKADA"); |
| 839 | MODULE_LICENSE("GPL"); |