0001
0002
0003
0004
0005
0006
0007
0008 #include "m88ds3103_priv.h"
0009
0010 static const struct dvb_frontend_ops m88ds3103_ops;
0011
0012
0013 static int m88ds3103_update_bits(struct m88ds3103_dev *dev,
0014 u8 reg, u8 mask, u8 val)
0015 {
0016 int ret;
0017 u8 tmp;
0018
0019
0020 if (mask != 0xff) {
0021 ret = regmap_bulk_read(dev->regmap, reg, &tmp, 1);
0022 if (ret)
0023 return ret;
0024
0025 val &= mask;
0026 tmp &= ~mask;
0027 val |= tmp;
0028 }
0029
0030 return regmap_bulk_write(dev->regmap, reg, &val, 1);
0031 }
0032
0033
0034 static int m88ds3103_wr_reg_val_tab(struct m88ds3103_dev *dev,
0035 const struct m88ds3103_reg_val *tab, int tab_len)
0036 {
0037 struct i2c_client *client = dev->client;
0038 int ret, i, j;
0039 u8 buf[83];
0040
0041 dev_dbg(&client->dev, "tab_len=%d\n", tab_len);
0042
0043 if (tab_len > 86) {
0044 ret = -EINVAL;
0045 goto err;
0046 }
0047
0048 for (i = 0, j = 0; i < tab_len; i++, j++) {
0049 buf[j] = tab[i].val;
0050
0051 if (i == tab_len - 1 || tab[i].reg != tab[i + 1].reg - 1 ||
0052 !((j + 1) % (dev->cfg->i2c_wr_max - 1))) {
0053 ret = regmap_bulk_write(dev->regmap, tab[i].reg - j, buf, j + 1);
0054 if (ret)
0055 goto err;
0056
0057 j = -1;
0058 }
0059 }
0060
0061 return 0;
0062 err:
0063 dev_dbg(&client->dev, "failed=%d\n", ret);
0064 return ret;
0065 }
0066
0067
0068
0069
0070
0071 static int m88ds3103b_dt_write(struct m88ds3103_dev *dev, int reg, int data)
0072 {
0073 struct i2c_client *client = dev->client;
0074 u8 buf[] = {reg, data};
0075 u8 val;
0076 int ret;
0077 struct i2c_msg msg = {
0078 .addr = dev->dt_addr, .flags = 0, .buf = buf, .len = 2
0079 };
0080
0081 m88ds3103_update_bits(dev, 0x11, 0x01, 0x00);
0082
0083 val = 0x11;
0084 ret = regmap_write(dev->regmap, 0x03, val);
0085 if (ret)
0086 dev_dbg(&client->dev, "fail=%d\n", ret);
0087
0088 ret = i2c_transfer(dev->dt_client->adapter, &msg, 1);
0089 if (ret != 1) {
0090 dev_err(&client->dev, "0x%02x (ret=%i, reg=0x%02x, value=0x%02x)\n",
0091 dev->dt_addr, ret, reg, data);
0092
0093 m88ds3103_update_bits(dev, 0x11, 0x01, 0x01);
0094 return -EREMOTEIO;
0095 }
0096 m88ds3103_update_bits(dev, 0x11, 0x01, 0x01);
0097
0098 dev_dbg(&client->dev, "0x%02x reg 0x%02x, value 0x%02x\n",
0099 dev->dt_addr, reg, data);
0100
0101 return 0;
0102 }
0103
0104
0105
0106
0107
0108 static int m88ds3103b_dt_read(struct m88ds3103_dev *dev, u8 reg)
0109 {
0110 struct i2c_client *client = dev->client;
0111 int ret;
0112 u8 val;
0113 u8 b0[] = { reg };
0114 u8 b1[] = { 0 };
0115 struct i2c_msg msg[] = {
0116 {
0117 .addr = dev->dt_addr,
0118 .flags = 0,
0119 .buf = b0,
0120 .len = 1
0121 },
0122 {
0123 .addr = dev->dt_addr,
0124 .flags = I2C_M_RD,
0125 .buf = b1,
0126 .len = 1
0127 }
0128 };
0129
0130 m88ds3103_update_bits(dev, 0x11, 0x01, 0x00);
0131
0132 val = 0x12;
0133 ret = regmap_write(dev->regmap, 0x03, val);
0134 if (ret)
0135 dev_dbg(&client->dev, "fail=%d\n", ret);
0136
0137 ret = i2c_transfer(dev->dt_client->adapter, msg, 2);
0138 if (ret != 2) {
0139 dev_err(&client->dev, "0x%02x (ret=%d, reg=0x%02x)\n",
0140 dev->dt_addr, ret, reg);
0141
0142 m88ds3103_update_bits(dev, 0x11, 0x01, 0x01);
0143 return -EREMOTEIO;
0144 }
0145 m88ds3103_update_bits(dev, 0x11, 0x01, 0x01);
0146
0147 dev_dbg(&client->dev, "0x%02x reg 0x%02x, value 0x%02x\n",
0148 dev->dt_addr, reg, b1[0]);
0149
0150 return b1[0];
0151 }
0152
0153
0154
0155
0156 int m88ds3103_get_agc_pwm(struct dvb_frontend *fe, u8 *_agc_pwm)
0157 {
0158 struct m88ds3103_dev *dev = fe->demodulator_priv;
0159 unsigned tmp;
0160 int ret;
0161
0162 ret = regmap_read(dev->regmap, 0x3f, &tmp);
0163 if (ret == 0)
0164 *_agc_pwm = tmp;
0165 return ret;
0166 }
0167 EXPORT_SYMBOL(m88ds3103_get_agc_pwm);
0168
0169 static int m88ds3103_read_status(struct dvb_frontend *fe,
0170 enum fe_status *status)
0171 {
0172 struct m88ds3103_dev *dev = fe->demodulator_priv;
0173 struct i2c_client *client = dev->client;
0174 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
0175 int ret, i, itmp;
0176 unsigned int utmp;
0177 u8 buf[3];
0178
0179 *status = 0;
0180
0181 if (!dev->warm) {
0182 ret = -EAGAIN;
0183 goto err;
0184 }
0185
0186 switch (c->delivery_system) {
0187 case SYS_DVBS:
0188 ret = regmap_read(dev->regmap, 0xd1, &utmp);
0189 if (ret)
0190 goto err;
0191
0192 if ((utmp & 0x07) == 0x07)
0193 *status = FE_HAS_SIGNAL | FE_HAS_CARRIER |
0194 FE_HAS_VITERBI | FE_HAS_SYNC |
0195 FE_HAS_LOCK;
0196 break;
0197 case SYS_DVBS2:
0198 ret = regmap_read(dev->regmap, 0x0d, &utmp);
0199 if (ret)
0200 goto err;
0201
0202 if ((utmp & 0x8f) == 0x8f)
0203 *status = FE_HAS_SIGNAL | FE_HAS_CARRIER |
0204 FE_HAS_VITERBI | FE_HAS_SYNC |
0205 FE_HAS_LOCK;
0206 break;
0207 default:
0208 dev_dbg(&client->dev, "invalid delivery_system\n");
0209 ret = -EINVAL;
0210 goto err;
0211 }
0212
0213 dev->fe_status = *status;
0214 dev_dbg(&client->dev, "lock=%02x status=%02x\n", utmp, *status);
0215
0216
0217 if (dev->fe_status & FE_HAS_VITERBI) {
0218 unsigned int cnr, noise, signal, noise_tot, signal_tot;
0219
0220 cnr = 0;
0221
0222 #define M88DS3103_SNR_ITERATIONS 3
0223
0224 switch (c->delivery_system) {
0225 case SYS_DVBS:
0226 itmp = 0;
0227
0228 for (i = 0; i < M88DS3103_SNR_ITERATIONS; i++) {
0229 ret = regmap_read(dev->regmap, 0xff, &utmp);
0230 if (ret)
0231 goto err;
0232
0233 itmp += utmp;
0234 }
0235
0236
0237
0238 itmp = DIV_ROUND_CLOSEST(itmp, 8 * M88DS3103_SNR_ITERATIONS);
0239 if (itmp)
0240 cnr = div_u64((u64) 10000 * intlog2(itmp), intlog2(10));
0241 break;
0242 case SYS_DVBS2:
0243 noise_tot = 0;
0244 signal_tot = 0;
0245
0246 for (i = 0; i < M88DS3103_SNR_ITERATIONS; i++) {
0247 ret = regmap_bulk_read(dev->regmap, 0x8c, buf, 3);
0248 if (ret)
0249 goto err;
0250
0251 noise = buf[1] << 6;
0252 noise |= buf[0] & 0x3f;
0253 noise >>= 2;
0254 signal = buf[2] * buf[2];
0255 signal >>= 1;
0256
0257 noise_tot += noise;
0258 signal_tot += signal;
0259 }
0260
0261 noise = noise_tot / M88DS3103_SNR_ITERATIONS;
0262 signal = signal_tot / M88DS3103_SNR_ITERATIONS;
0263
0264
0265 if (signal > noise) {
0266 itmp = signal / noise;
0267 cnr = div_u64((u64) 10000 * intlog10(itmp), (1 << 24));
0268 }
0269 break;
0270 default:
0271 dev_dbg(&client->dev, "invalid delivery_system\n");
0272 ret = -EINVAL;
0273 goto err;
0274 }
0275
0276 if (cnr) {
0277 c->cnr.stat[0].scale = FE_SCALE_DECIBEL;
0278 c->cnr.stat[0].svalue = cnr;
0279 } else {
0280 c->cnr.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
0281 }
0282 } else {
0283 c->cnr.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
0284 }
0285
0286
0287 if (dev->fe_status & FE_HAS_LOCK) {
0288 unsigned int utmp, post_bit_error, post_bit_count;
0289
0290 switch (c->delivery_system) {
0291 case SYS_DVBS:
0292 ret = regmap_write(dev->regmap, 0xf9, 0x04);
0293 if (ret)
0294 goto err;
0295
0296 ret = regmap_read(dev->regmap, 0xf8, &utmp);
0297 if (ret)
0298 goto err;
0299
0300
0301 if (!(utmp & 0x10)) {
0302 ret = regmap_bulk_read(dev->regmap, 0xf6, buf, 2);
0303 if (ret)
0304 goto err;
0305
0306 post_bit_error = buf[1] << 8 | buf[0] << 0;
0307 post_bit_count = 0x800000;
0308 dev->post_bit_error += post_bit_error;
0309 dev->post_bit_count += post_bit_count;
0310 dev->dvbv3_ber = post_bit_error;
0311
0312
0313 utmp |= 0x10;
0314 ret = regmap_write(dev->regmap, 0xf8, utmp);
0315 if (ret)
0316 goto err;
0317 }
0318 break;
0319 case SYS_DVBS2:
0320 ret = regmap_bulk_read(dev->regmap, 0xd5, buf, 3);
0321 if (ret)
0322 goto err;
0323
0324 utmp = buf[2] << 16 | buf[1] << 8 | buf[0] << 0;
0325
0326
0327 if (utmp > 4000) {
0328 ret = regmap_bulk_read(dev->regmap, 0xf7, buf, 2);
0329 if (ret)
0330 goto err;
0331
0332 post_bit_error = buf[1] << 8 | buf[0] << 0;
0333 post_bit_count = 32 * utmp;
0334 dev->post_bit_error += post_bit_error;
0335 dev->post_bit_count += post_bit_count;
0336 dev->dvbv3_ber = post_bit_error;
0337
0338
0339 ret = regmap_write(dev->regmap, 0xd1, 0x01);
0340 if (ret)
0341 goto err;
0342
0343 ret = regmap_write(dev->regmap, 0xf9, 0x01);
0344 if (ret)
0345 goto err;
0346
0347 ret = regmap_write(dev->regmap, 0xf9, 0x00);
0348 if (ret)
0349 goto err;
0350
0351 ret = regmap_write(dev->regmap, 0xd1, 0x00);
0352 if (ret)
0353 goto err;
0354 }
0355 break;
0356 default:
0357 dev_dbg(&client->dev, "invalid delivery_system\n");
0358 ret = -EINVAL;
0359 goto err;
0360 }
0361
0362 c->post_bit_error.stat[0].scale = FE_SCALE_COUNTER;
0363 c->post_bit_error.stat[0].uvalue = dev->post_bit_error;
0364 c->post_bit_count.stat[0].scale = FE_SCALE_COUNTER;
0365 c->post_bit_count.stat[0].uvalue = dev->post_bit_count;
0366 } else {
0367 c->post_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
0368 c->post_bit_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
0369 }
0370
0371 return 0;
0372 err:
0373 dev_dbg(&client->dev, "failed=%d\n", ret);
0374 return ret;
0375 }
0376
0377 static int m88ds3103b_select_mclk(struct m88ds3103_dev *dev)
0378 {
0379 struct i2c_client *client = dev->client;
0380 struct dtv_frontend_properties *c = &dev->fe.dtv_property_cache;
0381 u32 adc_Freq_MHz[3] = {96, 93, 99};
0382 u8 reg16_list[3] = {96, 92, 100}, reg16, reg15;
0383 u32 offset_MHz[3];
0384 u32 max_offset = 0;
0385 u32 old_setting = dev->mclk;
0386 u32 tuner_freq_MHz = c->frequency / 1000;
0387 u8 i;
0388 char big_symbol = 0;
0389
0390 big_symbol = (c->symbol_rate > 45010000) ? 1 : 0;
0391
0392 if (big_symbol) {
0393 reg16 = 115;
0394 } else {
0395 reg16 = 96;
0396
0397
0398 for (i = 0; i < 3; i++) {
0399 offset_MHz[i] = tuner_freq_MHz % adc_Freq_MHz[i];
0400
0401 if (offset_MHz[i] > (adc_Freq_MHz[i] / 2))
0402 offset_MHz[i] = adc_Freq_MHz[i] - offset_MHz[i];
0403
0404 if (offset_MHz[i] > max_offset) {
0405 max_offset = offset_MHz[i];
0406 reg16 = reg16_list[i];
0407 dev->mclk = adc_Freq_MHz[i] * 1000 * 1000;
0408
0409 if (big_symbol)
0410 dev->mclk /= 2;
0411
0412 dev_dbg(&client->dev, "modifying mclk %u -> %u\n",
0413 old_setting, dev->mclk);
0414 }
0415 }
0416 }
0417
0418 if (dev->mclk == 93000000)
0419 regmap_write(dev->regmap, 0xA0, 0x42);
0420 else if (dev->mclk == 96000000)
0421 regmap_write(dev->regmap, 0xA0, 0x44);
0422 else if (dev->mclk == 99000000)
0423 regmap_write(dev->regmap, 0xA0, 0x46);
0424 else if (dev->mclk == 110250000)
0425 regmap_write(dev->regmap, 0xA0, 0x4E);
0426 else
0427 regmap_write(dev->regmap, 0xA0, 0x44);
0428
0429 reg15 = m88ds3103b_dt_read(dev, 0x15);
0430
0431 m88ds3103b_dt_write(dev, 0x05, 0x40);
0432 m88ds3103b_dt_write(dev, 0x11, 0x08);
0433
0434 if (big_symbol)
0435 reg15 |= 0x02;
0436 else
0437 reg15 &= ~0x02;
0438
0439 m88ds3103b_dt_write(dev, 0x15, reg15);
0440 m88ds3103b_dt_write(dev, 0x16, reg16);
0441
0442 usleep_range(5000, 5500);
0443
0444 m88ds3103b_dt_write(dev, 0x05, 0x00);
0445 m88ds3103b_dt_write(dev, 0x11, (u8)(big_symbol ? 0x0E : 0x0A));
0446
0447 usleep_range(5000, 5500);
0448
0449 return 0;
0450 }
0451
0452 static int m88ds3103b_set_mclk(struct m88ds3103_dev *dev, u32 mclk_khz)
0453 {
0454 u8 reg15, reg16, reg1D, reg1E, reg1F, tmp;
0455 u8 sm, f0 = 0, f1 = 0, f2 = 0, f3 = 0;
0456 u16 pll_div_fb, N;
0457 u32 div;
0458
0459 reg15 = m88ds3103b_dt_read(dev, 0x15);
0460 reg16 = m88ds3103b_dt_read(dev, 0x16);
0461 reg1D = m88ds3103b_dt_read(dev, 0x1D);
0462
0463 if (dev->cfg->ts_mode != M88DS3103_TS_SERIAL) {
0464 if (reg16 == 92)
0465 tmp = 93;
0466 else if (reg16 == 100)
0467 tmp = 99;
0468 else
0469 tmp = 96;
0470
0471 mclk_khz *= tmp;
0472 mclk_khz /= 96;
0473 }
0474
0475 pll_div_fb = (reg15 & 0x01) << 8;
0476 pll_div_fb += reg16;
0477 pll_div_fb += 32;
0478
0479 div = 9000 * pll_div_fb * 4;
0480 div /= mclk_khz;
0481
0482 if (dev->cfg->ts_mode == M88DS3103_TS_SERIAL) {
0483 if (div <= 32) {
0484 N = 2;
0485
0486 f0 = 0;
0487 f1 = div / N;
0488 f2 = div - f1;
0489 f3 = 0;
0490 } else if (div <= 34) {
0491 N = 3;
0492
0493 f0 = div / N;
0494 f1 = (div - f0) / (N - 1);
0495 f2 = div - f0 - f1;
0496 f3 = 0;
0497 } else if (div <= 64) {
0498 N = 4;
0499
0500 f0 = div / N;
0501 f1 = (div - f0) / (N - 1);
0502 f2 = (div - f0 - f1) / (N - 2);
0503 f3 = div - f0 - f1 - f2;
0504 } else {
0505 N = 4;
0506
0507 f0 = 16;
0508 f1 = 16;
0509 f2 = 16;
0510 f3 = 16;
0511 }
0512
0513 if (f0 == 16)
0514 f0 = 0;
0515 else if ((f0 < 8) && (f0 != 0))
0516 f0 = 8;
0517
0518 if (f1 == 16)
0519 f1 = 0;
0520 else if ((f1 < 8) && (f1 != 0))
0521 f1 = 8;
0522
0523 if (f2 == 16)
0524 f2 = 0;
0525 else if ((f2 < 8) && (f2 != 0))
0526 f2 = 8;
0527
0528 if (f3 == 16)
0529 f3 = 0;
0530 else if ((f3 < 8) && (f3 != 0))
0531 f3 = 8;
0532 } else {
0533 if (div <= 32) {
0534 N = 2;
0535
0536 f0 = 0;
0537 f1 = div / N;
0538 f2 = div - f1;
0539 f3 = 0;
0540 } else if (div <= 48) {
0541 N = 3;
0542
0543 f0 = div / N;
0544 f1 = (div - f0) / (N - 1);
0545 f2 = div - f0 - f1;
0546 f3 = 0;
0547 } else if (div <= 64) {
0548 N = 4;
0549
0550 f0 = div / N;
0551 f1 = (div - f0) / (N - 1);
0552 f2 = (div - f0 - f1) / (N - 2);
0553 f3 = div - f0 - f1 - f2;
0554 } else {
0555 N = 4;
0556
0557 f0 = 16;
0558 f1 = 16;
0559 f2 = 16;
0560 f3 = 16;
0561 }
0562
0563 if (f0 == 16)
0564 f0 = 0;
0565 else if ((f0 < 9) && (f0 != 0))
0566 f0 = 9;
0567
0568 if (f1 == 16)
0569 f1 = 0;
0570 else if ((f1 < 9) && (f1 != 0))
0571 f1 = 9;
0572
0573 if (f2 == 16)
0574 f2 = 0;
0575 else if ((f2 < 9) && (f2 != 0))
0576 f2 = 9;
0577
0578 if (f3 == 16)
0579 f3 = 0;
0580 else if ((f3 < 9) && (f3 != 0))
0581 f3 = 9;
0582 }
0583
0584 sm = N - 1;
0585
0586
0587
0588
0589
0590
0591
0592 reg1D &= ~0x03;
0593 reg1D |= sm;
0594 reg1D |= 0x80;
0595
0596 reg1E = ((f3 << 4) + f2) & 0xFF;
0597 reg1F = ((f1 << 4) + f0) & 0xFF;
0598
0599 m88ds3103b_dt_write(dev, 0x05, 0x40);
0600 m88ds3103b_dt_write(dev, 0x11, 0x08);
0601 m88ds3103b_dt_write(dev, 0x1D, reg1D);
0602 m88ds3103b_dt_write(dev, 0x1E, reg1E);
0603 m88ds3103b_dt_write(dev, 0x1F, reg1F);
0604
0605 m88ds3103b_dt_write(dev, 0x17, 0xc1);
0606 m88ds3103b_dt_write(dev, 0x17, 0x81);
0607
0608 usleep_range(5000, 5500);
0609
0610 m88ds3103b_dt_write(dev, 0x05, 0x00);
0611 m88ds3103b_dt_write(dev, 0x11, 0x0A);
0612
0613 usleep_range(5000, 5500);
0614
0615 return 0;
0616 }
0617
0618 static int m88ds3103_set_frontend(struct dvb_frontend *fe)
0619 {
0620 struct m88ds3103_dev *dev = fe->demodulator_priv;
0621 struct i2c_client *client = dev->client;
0622 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
0623 int ret, len;
0624 const struct m88ds3103_reg_val *init;
0625 u8 u8tmp, u8tmp1 = 0, u8tmp2 = 0;
0626 u8 buf[3];
0627 u16 u16tmp;
0628 u32 tuner_frequency_khz, target_mclk, u32tmp;
0629 s32 s32tmp;
0630 static const struct reg_sequence reset_buf[] = {
0631 {0x07, 0x80}, {0x07, 0x00}
0632 };
0633
0634 dev_dbg(&client->dev,
0635 "delivery_system=%d modulation=%d frequency=%u symbol_rate=%d inversion=%d pilot=%d rolloff=%d\n",
0636 c->delivery_system, c->modulation, c->frequency, c->symbol_rate,
0637 c->inversion, c->pilot, c->rolloff);
0638
0639 if (!dev->warm) {
0640 ret = -EAGAIN;
0641 goto err;
0642 }
0643
0644
0645 ret = regmap_multi_reg_write(dev->regmap, reset_buf, 2);
0646 if (ret)
0647 goto err;
0648
0649
0650 if (dev->chip_id == M88RS6000_CHIP_ID) {
0651 if (dev->chiptype == M88DS3103_CHIPTYPE_3103B) {
0652 ret = regmap_read(dev->regmap, 0xb2, &u32tmp);
0653 if (ret)
0654 goto err;
0655 if (u32tmp == 0x01) {
0656 ret = regmap_write(dev->regmap, 0x00, 0x00);
0657 if (ret)
0658 goto err;
0659 ret = regmap_write(dev->regmap, 0xb2, 0x00);
0660 if (ret)
0661 goto err;
0662 }
0663 }
0664
0665 ret = regmap_write(dev->regmap, 0x06, 0xe0);
0666 if (ret)
0667 goto err;
0668 }
0669
0670
0671 if (fe->ops.tuner_ops.set_params) {
0672 ret = fe->ops.tuner_ops.set_params(fe);
0673 if (ret)
0674 goto err;
0675 }
0676
0677 if (fe->ops.tuner_ops.get_frequency) {
0678 ret = fe->ops.tuner_ops.get_frequency(fe, &tuner_frequency_khz);
0679 if (ret)
0680 goto err;
0681 } else {
0682
0683
0684
0685
0686
0687 tuner_frequency_khz = c->frequency;
0688 }
0689
0690
0691 if (dev->chip_id == M88RS6000_CHIP_ID) {
0692 if (c->symbol_rate > 45010000)
0693 dev->mclk = 110250000;
0694 else
0695 dev->mclk = 96000000;
0696
0697 if (c->delivery_system == SYS_DVBS)
0698 target_mclk = 96000000;
0699 else
0700 target_mclk = 144000000;
0701
0702 if (dev->chiptype == M88DS3103_CHIPTYPE_3103B) {
0703 m88ds3103b_select_mclk(dev);
0704 m88ds3103b_set_mclk(dev, target_mclk / 1000);
0705 }
0706
0707
0708 ret = regmap_write(dev->regmap, 0x06, 0x00);
0709 if (ret)
0710 goto err;
0711 usleep_range(10000, 20000);
0712 } else {
0713
0714 dev->mclk = 96000000;
0715
0716 switch (dev->cfg->ts_mode) {
0717 case M88DS3103_TS_SERIAL:
0718 case M88DS3103_TS_SERIAL_D7:
0719 target_mclk = dev->cfg->ts_clk;
0720 break;
0721 case M88DS3103_TS_PARALLEL:
0722 case M88DS3103_TS_CI:
0723 if (c->delivery_system == SYS_DVBS)
0724 target_mclk = 96000000;
0725 else {
0726 if (c->symbol_rate < 18000000)
0727 target_mclk = 96000000;
0728 else if (c->symbol_rate < 28000000)
0729 target_mclk = 144000000;
0730 else
0731 target_mclk = 192000000;
0732 }
0733 break;
0734 default:
0735 dev_dbg(&client->dev, "invalid ts_mode\n");
0736 ret = -EINVAL;
0737 goto err;
0738 }
0739
0740 switch (target_mclk) {
0741 case 96000000:
0742 u8tmp1 = 0x02;
0743 u8tmp2 = 0x01;
0744 break;
0745 case 144000000:
0746 u8tmp1 = 0x00;
0747 u8tmp2 = 0x01;
0748 break;
0749 case 192000000:
0750 u8tmp1 = 0x03;
0751 u8tmp2 = 0x00;
0752 break;
0753 }
0754 ret = m88ds3103_update_bits(dev, 0x22, 0xc0, u8tmp1 << 6);
0755 if (ret)
0756 goto err;
0757 ret = m88ds3103_update_bits(dev, 0x24, 0xc0, u8tmp2 << 6);
0758 if (ret)
0759 goto err;
0760 }
0761
0762 ret = regmap_write(dev->regmap, 0xb2, 0x01);
0763 if (ret)
0764 goto err;
0765
0766 ret = regmap_write(dev->regmap, 0x00, 0x01);
0767 if (ret)
0768 goto err;
0769
0770 switch (c->delivery_system) {
0771 case SYS_DVBS:
0772 if (dev->chip_id == M88RS6000_CHIP_ID) {
0773 len = ARRAY_SIZE(m88rs6000_dvbs_init_reg_vals);
0774 init = m88rs6000_dvbs_init_reg_vals;
0775 } else {
0776 len = ARRAY_SIZE(m88ds3103_dvbs_init_reg_vals);
0777 init = m88ds3103_dvbs_init_reg_vals;
0778 }
0779 break;
0780 case SYS_DVBS2:
0781 if (dev->chip_id == M88RS6000_CHIP_ID) {
0782 len = ARRAY_SIZE(m88rs6000_dvbs2_init_reg_vals);
0783 init = m88rs6000_dvbs2_init_reg_vals;
0784 } else {
0785 len = ARRAY_SIZE(m88ds3103_dvbs2_init_reg_vals);
0786 init = m88ds3103_dvbs2_init_reg_vals;
0787 }
0788 break;
0789 default:
0790 dev_dbg(&client->dev, "invalid delivery_system\n");
0791 ret = -EINVAL;
0792 goto err;
0793 }
0794
0795
0796 if (c->delivery_system != dev->delivery_system) {
0797 ret = m88ds3103_wr_reg_val_tab(dev, init, len);
0798 if (ret)
0799 goto err;
0800 }
0801
0802 if (dev->chip_id == M88RS6000_CHIP_ID) {
0803 if (c->delivery_system == SYS_DVBS2 &&
0804 c->symbol_rate <= 5000000) {
0805 ret = regmap_write(dev->regmap, 0xc0, 0x04);
0806 if (ret)
0807 goto err;
0808 buf[0] = 0x09;
0809 buf[1] = 0x22;
0810 buf[2] = 0x88;
0811 ret = regmap_bulk_write(dev->regmap, 0x8a, buf, 3);
0812 if (ret)
0813 goto err;
0814 }
0815 ret = m88ds3103_update_bits(dev, 0x9d, 0x08, 0x08);
0816 if (ret)
0817 goto err;
0818
0819 if (dev->chiptype == M88DS3103_CHIPTYPE_3103B) {
0820 buf[0] = m88ds3103b_dt_read(dev, 0x15);
0821 buf[1] = m88ds3103b_dt_read(dev, 0x16);
0822
0823 if (c->symbol_rate > 45010000) {
0824 buf[0] &= ~0x03;
0825 buf[0] |= 0x02;
0826 buf[0] |= ((147 - 32) >> 8) & 0x01;
0827 buf[1] = (147 - 32) & 0xFF;
0828
0829 dev->mclk = 110250 * 1000;
0830 } else {
0831 buf[0] &= ~0x03;
0832 buf[0] |= ((128 - 32) >> 8) & 0x01;
0833 buf[1] = (128 - 32) & 0xFF;
0834
0835 dev->mclk = 96000 * 1000;
0836 }
0837 m88ds3103b_dt_write(dev, 0x15, buf[0]);
0838 m88ds3103b_dt_write(dev, 0x16, buf[1]);
0839
0840 regmap_read(dev->regmap, 0x30, &u32tmp);
0841 u32tmp &= ~0x80;
0842 regmap_write(dev->regmap, 0x30, u32tmp & 0xff);
0843 }
0844
0845 ret = regmap_write(dev->regmap, 0xf1, 0x01);
0846 if (ret)
0847 goto err;
0848
0849 if (dev->chiptype != M88DS3103_CHIPTYPE_3103B) {
0850 ret = m88ds3103_update_bits(dev, 0x30, 0x80, 0x80);
0851 if (ret)
0852 goto err;
0853 }
0854 }
0855
0856 switch (dev->cfg->ts_mode) {
0857 case M88DS3103_TS_SERIAL:
0858 u8tmp1 = 0x00;
0859 u8tmp = 0x06;
0860 break;
0861 case M88DS3103_TS_SERIAL_D7:
0862 u8tmp1 = 0x20;
0863 u8tmp = 0x06;
0864 break;
0865 case M88DS3103_TS_PARALLEL:
0866 u8tmp = 0x02;
0867 if (dev->chiptype == M88DS3103_CHIPTYPE_3103B) {
0868 u8tmp = 0x01;
0869 u8tmp1 = 0x01;
0870 }
0871 break;
0872 case M88DS3103_TS_CI:
0873 u8tmp = 0x03;
0874 break;
0875 default:
0876 dev_dbg(&client->dev, "invalid ts_mode\n");
0877 ret = -EINVAL;
0878 goto err;
0879 }
0880
0881 if (dev->cfg->ts_clk_pol)
0882 u8tmp |= 0x40;
0883
0884
0885 ret = regmap_write(dev->regmap, 0xfd, u8tmp);
0886 if (ret)
0887 goto err;
0888
0889 switch (dev->cfg->ts_mode) {
0890 case M88DS3103_TS_SERIAL:
0891 case M88DS3103_TS_SERIAL_D7:
0892 ret = m88ds3103_update_bits(dev, 0x29, 0x20, u8tmp1);
0893 if (ret)
0894 goto err;
0895 u16tmp = 0;
0896 u8tmp1 = 0x3f;
0897 u8tmp2 = 0x3f;
0898 break;
0899 case M88DS3103_TS_PARALLEL:
0900 if (dev->chiptype == M88DS3103_CHIPTYPE_3103B) {
0901 ret = m88ds3103_update_bits(dev, 0x29, 0x01, u8tmp1);
0902 if (ret)
0903 goto err;
0904 }
0905 fallthrough;
0906 default:
0907 u16tmp = DIV_ROUND_UP(target_mclk, dev->cfg->ts_clk);
0908 u8tmp1 = u16tmp / 2 - 1;
0909 u8tmp2 = DIV_ROUND_UP(u16tmp, 2) - 1;
0910 }
0911
0912 dev_dbg(&client->dev, "target_mclk=%u ts_clk=%u ts_clk_divide_ratio=%u\n",
0913 target_mclk, dev->cfg->ts_clk, u16tmp);
0914
0915
0916
0917 u8tmp = (u8tmp1 >> 2) & 0x0f;
0918 ret = regmap_update_bits(dev->regmap, 0xfe, 0x0f, u8tmp);
0919 if (ret)
0920 goto err;
0921 u8tmp = ((u8tmp1 & 0x03) << 6) | u8tmp2 >> 0;
0922 ret = regmap_write(dev->regmap, 0xea, u8tmp);
0923 if (ret)
0924 goto err;
0925
0926 if (c->symbol_rate <= 3000000)
0927 u8tmp = 0x20;
0928 else if (c->symbol_rate <= 10000000)
0929 u8tmp = 0x10;
0930 else
0931 u8tmp = 0x06;
0932
0933 if (dev->chiptype == M88DS3103_CHIPTYPE_3103B)
0934 m88ds3103b_set_mclk(dev, target_mclk / 1000);
0935
0936 ret = regmap_write(dev->regmap, 0xc3, 0x08);
0937 if (ret)
0938 goto err;
0939
0940 ret = regmap_write(dev->regmap, 0xc8, u8tmp);
0941 if (ret)
0942 goto err;
0943
0944 ret = regmap_write(dev->regmap, 0xc4, 0x08);
0945 if (ret)
0946 goto err;
0947
0948 ret = regmap_write(dev->regmap, 0xc7, 0x00);
0949 if (ret)
0950 goto err;
0951
0952 u16tmp = DIV_ROUND_CLOSEST_ULL((u64)c->symbol_rate * 0x10000, dev->mclk);
0953 buf[0] = (u16tmp >> 0) & 0xff;
0954 buf[1] = (u16tmp >> 8) & 0xff;
0955 ret = regmap_bulk_write(dev->regmap, 0x61, buf, 2);
0956 if (ret)
0957 goto err;
0958
0959 ret = m88ds3103_update_bits(dev, 0x4d, 0x02, dev->cfg->spec_inv << 1);
0960 if (ret)
0961 goto err;
0962
0963 ret = m88ds3103_update_bits(dev, 0x30, 0x10, dev->cfg->agc_inv << 4);
0964 if (ret)
0965 goto err;
0966
0967 ret = regmap_write(dev->regmap, 0x33, dev->cfg->agc);
0968 if (ret)
0969 goto err;
0970
0971 if (dev->chiptype == M88DS3103_CHIPTYPE_3103B) {
0972
0973 ret = m88ds3103_update_bits(dev, 0x29, 0x10,
0974 (c->delivery_system == SYS_DVBS) ? 0x10 : 0x0);
0975 if (ret)
0976 goto err;
0977
0978 ret = m88ds3103_update_bits(dev, 0xc9, 0x08, 0x08);
0979 if (ret)
0980 goto err;
0981 }
0982
0983 dev_dbg(&client->dev, "carrier offset=%d\n",
0984 (tuner_frequency_khz - c->frequency));
0985
0986
0987 s32tmp = 0x10000 * (tuner_frequency_khz - c->frequency);
0988 s32tmp = DIV_ROUND_CLOSEST(s32tmp, dev->mclk / 1000);
0989 buf[0] = (s32tmp >> 0) & 0xff;
0990 buf[1] = (s32tmp >> 8) & 0xff;
0991 ret = regmap_bulk_write(dev->regmap, 0x5e, buf, 2);
0992 if (ret)
0993 goto err;
0994
0995 ret = regmap_write(dev->regmap, 0x00, 0x00);
0996 if (ret)
0997 goto err;
0998
0999 ret = regmap_write(dev->regmap, 0xb2, 0x00);
1000 if (ret)
1001 goto err;
1002
1003 dev->delivery_system = c->delivery_system;
1004
1005 return 0;
1006 err:
1007 dev_dbg(&client->dev, "failed=%d\n", ret);
1008 return ret;
1009 }
1010
1011 static int m88ds3103_init(struct dvb_frontend *fe)
1012 {
1013 struct m88ds3103_dev *dev = fe->demodulator_priv;
1014 struct i2c_client *client = dev->client;
1015 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
1016 int ret, len, rem;
1017 unsigned int utmp;
1018 const struct firmware *firmware;
1019 const char *name;
1020
1021 dev_dbg(&client->dev, "\n");
1022
1023
1024 dev->warm = false;
1025
1026
1027 ret = m88ds3103_update_bits(dev, 0x08, 0x01, 0x01);
1028 if (ret)
1029 goto err;
1030 ret = m88ds3103_update_bits(dev, 0x04, 0x01, 0x00);
1031 if (ret)
1032 goto err;
1033 ret = m88ds3103_update_bits(dev, 0x23, 0x10, 0x00);
1034 if (ret)
1035 goto err;
1036
1037
1038 ret = regmap_read(dev->regmap, 0xb9, &utmp);
1039 if (ret)
1040 goto err;
1041
1042 dev_dbg(&client->dev, "firmware=%02x\n", utmp);
1043
1044 if (utmp)
1045 goto warm;
1046
1047
1048 ret = regmap_write(dev->regmap, 0x07, 0xe0);
1049 if (ret)
1050 goto err;
1051 ret = regmap_write(dev->regmap, 0x07, 0x00);
1052 if (ret)
1053 goto err;
1054
1055
1056 dev_info(&client->dev, "found a '%s' in cold state\n",
1057 dev->fe.ops.info.name);
1058
1059 if (dev->chiptype == M88DS3103_CHIPTYPE_3103B)
1060 name = M88DS3103B_FIRMWARE;
1061 else if (dev->chip_id == M88RS6000_CHIP_ID)
1062 name = M88RS6000_FIRMWARE;
1063 else
1064 name = M88DS3103_FIRMWARE;
1065
1066
1067 ret = request_firmware(&firmware, name, &client->dev);
1068 if (ret) {
1069 dev_err(&client->dev, "firmware file '%s' not found\n", name);
1070 goto err;
1071 }
1072
1073 dev_info(&client->dev, "downloading firmware from file '%s'\n", name);
1074
1075 ret = regmap_write(dev->regmap, 0xb2, 0x01);
1076 if (ret)
1077 goto err_release_firmware;
1078
1079 for (rem = firmware->size; rem > 0; rem -= (dev->cfg->i2c_wr_max - 1)) {
1080 len = min(dev->cfg->i2c_wr_max - 1, rem);
1081 ret = regmap_bulk_write(dev->regmap, 0xb0,
1082 &firmware->data[firmware->size - rem],
1083 len);
1084 if (ret) {
1085 dev_err(&client->dev, "firmware download failed %d\n",
1086 ret);
1087 goto err_release_firmware;
1088 }
1089 }
1090
1091 ret = regmap_write(dev->regmap, 0xb2, 0x00);
1092 if (ret)
1093 goto err_release_firmware;
1094
1095 release_firmware(firmware);
1096
1097 ret = regmap_read(dev->regmap, 0xb9, &utmp);
1098 if (ret)
1099 goto err;
1100
1101 if (!utmp) {
1102 ret = -EINVAL;
1103 dev_info(&client->dev, "firmware did not run\n");
1104 goto err;
1105 }
1106
1107 dev_info(&client->dev, "found a '%s' in warm state\n",
1108 dev->fe.ops.info.name);
1109 dev_info(&client->dev, "firmware version: %X.%X\n",
1110 (utmp >> 4) & 0xf, (utmp >> 0 & 0xf));
1111
1112 if (dev->chiptype == M88DS3103_CHIPTYPE_3103B) {
1113 m88ds3103b_dt_write(dev, 0x21, 0x92);
1114 m88ds3103b_dt_write(dev, 0x15, 0x6C);
1115 m88ds3103b_dt_write(dev, 0x17, 0xC1);
1116 m88ds3103b_dt_write(dev, 0x17, 0x81);
1117 }
1118 warm:
1119
1120 dev->warm = true;
1121
1122
1123 c->cnr.len = 1;
1124 c->cnr.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
1125 c->post_bit_error.len = 1;
1126 c->post_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
1127 c->post_bit_count.len = 1;
1128 c->post_bit_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
1129
1130 return 0;
1131 err_release_firmware:
1132 release_firmware(firmware);
1133 err:
1134 dev_dbg(&client->dev, "failed=%d\n", ret);
1135 return ret;
1136 }
1137
1138 static int m88ds3103_sleep(struct dvb_frontend *fe)
1139 {
1140 struct m88ds3103_dev *dev = fe->demodulator_priv;
1141 struct i2c_client *client = dev->client;
1142 int ret;
1143 unsigned int utmp;
1144
1145 dev_dbg(&client->dev, "\n");
1146
1147 dev->fe_status = 0;
1148 dev->delivery_system = SYS_UNDEFINED;
1149
1150
1151 if (dev->chip_id == M88RS6000_CHIP_ID)
1152 utmp = 0x29;
1153 else
1154 utmp = 0x27;
1155 ret = m88ds3103_update_bits(dev, utmp, 0x01, 0x00);
1156 if (ret)
1157 goto err;
1158
1159
1160 ret = m88ds3103_update_bits(dev, 0x08, 0x01, 0x00);
1161 if (ret)
1162 goto err;
1163 ret = m88ds3103_update_bits(dev, 0x04, 0x01, 0x01);
1164 if (ret)
1165 goto err;
1166 ret = m88ds3103_update_bits(dev, 0x23, 0x10, 0x10);
1167 if (ret)
1168 goto err;
1169
1170 return 0;
1171 err:
1172 dev_dbg(&client->dev, "failed=%d\n", ret);
1173 return ret;
1174 }
1175
1176 static int m88ds3103_get_frontend(struct dvb_frontend *fe,
1177 struct dtv_frontend_properties *c)
1178 {
1179 struct m88ds3103_dev *dev = fe->demodulator_priv;
1180 struct i2c_client *client = dev->client;
1181 int ret;
1182 u8 buf[3];
1183
1184 dev_dbg(&client->dev, "\n");
1185
1186 if (!dev->warm || !(dev->fe_status & FE_HAS_LOCK)) {
1187 ret = 0;
1188 goto err;
1189 }
1190
1191 switch (c->delivery_system) {
1192 case SYS_DVBS:
1193 ret = regmap_bulk_read(dev->regmap, 0xe0, &buf[0], 1);
1194 if (ret)
1195 goto err;
1196
1197 ret = regmap_bulk_read(dev->regmap, 0xe6, &buf[1], 1);
1198 if (ret)
1199 goto err;
1200
1201 switch ((buf[0] >> 2) & 0x01) {
1202 case 0:
1203 c->inversion = INVERSION_OFF;
1204 break;
1205 case 1:
1206 c->inversion = INVERSION_ON;
1207 break;
1208 }
1209
1210 switch ((buf[1] >> 5) & 0x07) {
1211 case 0:
1212 c->fec_inner = FEC_7_8;
1213 break;
1214 case 1:
1215 c->fec_inner = FEC_5_6;
1216 break;
1217 case 2:
1218 c->fec_inner = FEC_3_4;
1219 break;
1220 case 3:
1221 c->fec_inner = FEC_2_3;
1222 break;
1223 case 4:
1224 c->fec_inner = FEC_1_2;
1225 break;
1226 default:
1227 dev_dbg(&client->dev, "invalid fec_inner\n");
1228 }
1229
1230 c->modulation = QPSK;
1231
1232 break;
1233 case SYS_DVBS2:
1234 ret = regmap_bulk_read(dev->regmap, 0x7e, &buf[0], 1);
1235 if (ret)
1236 goto err;
1237
1238 ret = regmap_bulk_read(dev->regmap, 0x89, &buf[1], 1);
1239 if (ret)
1240 goto err;
1241
1242 ret = regmap_bulk_read(dev->regmap, 0xf2, &buf[2], 1);
1243 if (ret)
1244 goto err;
1245
1246 switch ((buf[0] >> 0) & 0x0f) {
1247 case 2:
1248 c->fec_inner = FEC_2_5;
1249 break;
1250 case 3:
1251 c->fec_inner = FEC_1_2;
1252 break;
1253 case 4:
1254 c->fec_inner = FEC_3_5;
1255 break;
1256 case 5:
1257 c->fec_inner = FEC_2_3;
1258 break;
1259 case 6:
1260 c->fec_inner = FEC_3_4;
1261 break;
1262 case 7:
1263 c->fec_inner = FEC_4_5;
1264 break;
1265 case 8:
1266 c->fec_inner = FEC_5_6;
1267 break;
1268 case 9:
1269 c->fec_inner = FEC_8_9;
1270 break;
1271 case 10:
1272 c->fec_inner = FEC_9_10;
1273 break;
1274 default:
1275 dev_dbg(&client->dev, "invalid fec_inner\n");
1276 }
1277
1278 switch ((buf[0] >> 5) & 0x01) {
1279 case 0:
1280 c->pilot = PILOT_OFF;
1281 break;
1282 case 1:
1283 c->pilot = PILOT_ON;
1284 break;
1285 }
1286
1287 switch ((buf[0] >> 6) & 0x07) {
1288 case 0:
1289 c->modulation = QPSK;
1290 break;
1291 case 1:
1292 c->modulation = PSK_8;
1293 break;
1294 case 2:
1295 c->modulation = APSK_16;
1296 break;
1297 case 3:
1298 c->modulation = APSK_32;
1299 break;
1300 default:
1301 dev_dbg(&client->dev, "invalid modulation\n");
1302 }
1303
1304 switch ((buf[1] >> 7) & 0x01) {
1305 case 0:
1306 c->inversion = INVERSION_OFF;
1307 break;
1308 case 1:
1309 c->inversion = INVERSION_ON;
1310 break;
1311 }
1312
1313 switch ((buf[2] >> 0) & 0x03) {
1314 case 0:
1315 c->rolloff = ROLLOFF_35;
1316 break;
1317 case 1:
1318 c->rolloff = ROLLOFF_25;
1319 break;
1320 case 2:
1321 c->rolloff = ROLLOFF_20;
1322 break;
1323 default:
1324 dev_dbg(&client->dev, "invalid rolloff\n");
1325 }
1326 break;
1327 default:
1328 dev_dbg(&client->dev, "invalid delivery_system\n");
1329 ret = -EINVAL;
1330 goto err;
1331 }
1332
1333 ret = regmap_bulk_read(dev->regmap, 0x6d, buf, 2);
1334 if (ret)
1335 goto err;
1336
1337 c->symbol_rate = DIV_ROUND_CLOSEST_ULL((u64)(buf[1] << 8 | buf[0] << 0) * dev->mclk, 0x10000);
1338
1339 return 0;
1340 err:
1341 dev_dbg(&client->dev, "failed=%d\n", ret);
1342 return ret;
1343 }
1344
1345 static int m88ds3103_read_snr(struct dvb_frontend *fe, u16 *snr)
1346 {
1347 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
1348
1349 if (c->cnr.stat[0].scale == FE_SCALE_DECIBEL)
1350 *snr = div_s64(c->cnr.stat[0].svalue, 100);
1351 else
1352 *snr = 0;
1353
1354 return 0;
1355 }
1356
1357 static int m88ds3103_read_ber(struct dvb_frontend *fe, u32 *ber)
1358 {
1359 struct m88ds3103_dev *dev = fe->demodulator_priv;
1360
1361 *ber = dev->dvbv3_ber;
1362
1363 return 0;
1364 }
1365
1366 static int m88ds3103_set_tone(struct dvb_frontend *fe,
1367 enum fe_sec_tone_mode fe_sec_tone_mode)
1368 {
1369 struct m88ds3103_dev *dev = fe->demodulator_priv;
1370 struct i2c_client *client = dev->client;
1371 int ret;
1372 unsigned int utmp, tone, reg_a1_mask;
1373
1374 dev_dbg(&client->dev, "fe_sec_tone_mode=%d\n", fe_sec_tone_mode);
1375
1376 if (!dev->warm) {
1377 ret = -EAGAIN;
1378 goto err;
1379 }
1380
1381 switch (fe_sec_tone_mode) {
1382 case SEC_TONE_ON:
1383 tone = 0;
1384 reg_a1_mask = 0x47;
1385 break;
1386 case SEC_TONE_OFF:
1387 tone = 1;
1388 reg_a1_mask = 0x00;
1389 break;
1390 default:
1391 dev_dbg(&client->dev, "invalid fe_sec_tone_mode\n");
1392 ret = -EINVAL;
1393 goto err;
1394 }
1395
1396 utmp = tone << 7 | dev->cfg->envelope_mode << 5;
1397 ret = m88ds3103_update_bits(dev, 0xa2, 0xe0, utmp);
1398 if (ret)
1399 goto err;
1400
1401 utmp = 1 << 2;
1402 ret = m88ds3103_update_bits(dev, 0xa1, reg_a1_mask, utmp);
1403 if (ret)
1404 goto err;
1405
1406 return 0;
1407 err:
1408 dev_dbg(&client->dev, "failed=%d\n", ret);
1409 return ret;
1410 }
1411
1412 static int m88ds3103_set_voltage(struct dvb_frontend *fe,
1413 enum fe_sec_voltage fe_sec_voltage)
1414 {
1415 struct m88ds3103_dev *dev = fe->demodulator_priv;
1416 struct i2c_client *client = dev->client;
1417 int ret;
1418 unsigned int utmp;
1419 bool voltage_sel, voltage_dis;
1420
1421 dev_dbg(&client->dev, "fe_sec_voltage=%d\n", fe_sec_voltage);
1422
1423 if (!dev->warm) {
1424 ret = -EAGAIN;
1425 goto err;
1426 }
1427
1428 switch (fe_sec_voltage) {
1429 case SEC_VOLTAGE_18:
1430 voltage_sel = true;
1431 voltage_dis = false;
1432 break;
1433 case SEC_VOLTAGE_13:
1434 voltage_sel = false;
1435 voltage_dis = false;
1436 break;
1437 case SEC_VOLTAGE_OFF:
1438 voltage_sel = false;
1439 voltage_dis = true;
1440 break;
1441 default:
1442 dev_dbg(&client->dev, "invalid fe_sec_voltage\n");
1443 ret = -EINVAL;
1444 goto err;
1445 }
1446
1447
1448 voltage_sel ^= dev->cfg->lnb_hv_pol;
1449 voltage_dis ^= dev->cfg->lnb_en_pol;
1450
1451 utmp = voltage_dis << 1 | voltage_sel << 0;
1452 ret = m88ds3103_update_bits(dev, 0xa2, 0x03, utmp);
1453 if (ret)
1454 goto err;
1455
1456 return 0;
1457 err:
1458 dev_dbg(&client->dev, "failed=%d\n", ret);
1459 return ret;
1460 }
1461
1462 static int m88ds3103_diseqc_send_master_cmd(struct dvb_frontend *fe,
1463 struct dvb_diseqc_master_cmd *diseqc_cmd)
1464 {
1465 struct m88ds3103_dev *dev = fe->demodulator_priv;
1466 struct i2c_client *client = dev->client;
1467 int ret;
1468 unsigned int utmp;
1469 unsigned long timeout;
1470
1471 dev_dbg(&client->dev, "msg=%*ph\n",
1472 diseqc_cmd->msg_len, diseqc_cmd->msg);
1473
1474 if (!dev->warm) {
1475 ret = -EAGAIN;
1476 goto err;
1477 }
1478
1479 if (diseqc_cmd->msg_len < 3 || diseqc_cmd->msg_len > 6) {
1480 ret = -EINVAL;
1481 goto err;
1482 }
1483
1484 utmp = dev->cfg->envelope_mode << 5;
1485 ret = m88ds3103_update_bits(dev, 0xa2, 0xe0, utmp);
1486 if (ret)
1487 goto err;
1488
1489 ret = regmap_bulk_write(dev->regmap, 0xa3, diseqc_cmd->msg,
1490 diseqc_cmd->msg_len);
1491 if (ret)
1492 goto err;
1493
1494 ret = regmap_write(dev->regmap, 0xa1,
1495 (diseqc_cmd->msg_len - 1) << 3 | 0x07);
1496 if (ret)
1497 goto err;
1498
1499
1500 #define SEND_MASTER_CMD_TIMEOUT 120
1501 timeout = jiffies + msecs_to_jiffies(SEND_MASTER_CMD_TIMEOUT);
1502
1503
1504 utmp = diseqc_cmd->msg_len * 13500;
1505 usleep_range(utmp - 4000, utmp);
1506
1507 for (utmp = 1; !time_after(jiffies, timeout) && utmp;) {
1508 ret = regmap_read(dev->regmap, 0xa1, &utmp);
1509 if (ret)
1510 goto err;
1511 utmp = (utmp >> 6) & 0x1;
1512 }
1513
1514 if (utmp == 0) {
1515 dev_dbg(&client->dev, "diseqc tx took %u ms\n",
1516 jiffies_to_msecs(jiffies) -
1517 (jiffies_to_msecs(timeout) - SEND_MASTER_CMD_TIMEOUT));
1518 } else {
1519 dev_dbg(&client->dev, "diseqc tx timeout\n");
1520
1521 ret = m88ds3103_update_bits(dev, 0xa1, 0xc0, 0x40);
1522 if (ret)
1523 goto err;
1524 }
1525
1526 ret = m88ds3103_update_bits(dev, 0xa2, 0xc0, 0x80);
1527 if (ret)
1528 goto err;
1529
1530 if (utmp == 1) {
1531 ret = -ETIMEDOUT;
1532 goto err;
1533 }
1534
1535 return 0;
1536 err:
1537 dev_dbg(&client->dev, "failed=%d\n", ret);
1538 return ret;
1539 }
1540
1541 static int m88ds3103_diseqc_send_burst(struct dvb_frontend *fe,
1542 enum fe_sec_mini_cmd fe_sec_mini_cmd)
1543 {
1544 struct m88ds3103_dev *dev = fe->demodulator_priv;
1545 struct i2c_client *client = dev->client;
1546 int ret;
1547 unsigned int utmp, burst;
1548 unsigned long timeout;
1549
1550 dev_dbg(&client->dev, "fe_sec_mini_cmd=%d\n", fe_sec_mini_cmd);
1551
1552 if (!dev->warm) {
1553 ret = -EAGAIN;
1554 goto err;
1555 }
1556
1557 utmp = dev->cfg->envelope_mode << 5;
1558 ret = m88ds3103_update_bits(dev, 0xa2, 0xe0, utmp);
1559 if (ret)
1560 goto err;
1561
1562 switch (fe_sec_mini_cmd) {
1563 case SEC_MINI_A:
1564 burst = 0x02;
1565 break;
1566 case SEC_MINI_B:
1567 burst = 0x01;
1568 break;
1569 default:
1570 dev_dbg(&client->dev, "invalid fe_sec_mini_cmd\n");
1571 ret = -EINVAL;
1572 goto err;
1573 }
1574
1575 ret = regmap_write(dev->regmap, 0xa1, burst);
1576 if (ret)
1577 goto err;
1578
1579
1580 #define SEND_BURST_TIMEOUT 40
1581 timeout = jiffies + msecs_to_jiffies(SEND_BURST_TIMEOUT);
1582
1583
1584 usleep_range(8500, 12500);
1585
1586 for (utmp = 1; !time_after(jiffies, timeout) && utmp;) {
1587 ret = regmap_read(dev->regmap, 0xa1, &utmp);
1588 if (ret)
1589 goto err;
1590 utmp = (utmp >> 6) & 0x1;
1591 }
1592
1593 if (utmp == 0) {
1594 dev_dbg(&client->dev, "diseqc tx took %u ms\n",
1595 jiffies_to_msecs(jiffies) -
1596 (jiffies_to_msecs(timeout) - SEND_BURST_TIMEOUT));
1597 } else {
1598 dev_dbg(&client->dev, "diseqc tx timeout\n");
1599
1600 ret = m88ds3103_update_bits(dev, 0xa1, 0xc0, 0x40);
1601 if (ret)
1602 goto err;
1603 }
1604
1605 ret = m88ds3103_update_bits(dev, 0xa2, 0xc0, 0x80);
1606 if (ret)
1607 goto err;
1608
1609 if (utmp == 1) {
1610 ret = -ETIMEDOUT;
1611 goto err;
1612 }
1613
1614 return 0;
1615 err:
1616 dev_dbg(&client->dev, "failed=%d\n", ret);
1617 return ret;
1618 }
1619
1620 static int m88ds3103_get_tune_settings(struct dvb_frontend *fe,
1621 struct dvb_frontend_tune_settings *s)
1622 {
1623 s->min_delay_ms = 3000;
1624
1625 return 0;
1626 }
1627
1628 static void m88ds3103_release(struct dvb_frontend *fe)
1629 {
1630 struct m88ds3103_dev *dev = fe->demodulator_priv;
1631 struct i2c_client *client = dev->client;
1632
1633 i2c_unregister_device(client);
1634 }
1635
1636 static int m88ds3103_select(struct i2c_mux_core *muxc, u32 chan)
1637 {
1638 struct m88ds3103_dev *dev = i2c_mux_priv(muxc);
1639 struct i2c_client *client = dev->client;
1640 int ret;
1641 struct i2c_msg msg = {
1642 .addr = client->addr,
1643 .flags = 0,
1644 .len = 2,
1645 .buf = "\x03\x11",
1646 };
1647
1648
1649 ret = __i2c_transfer(client->adapter, &msg, 1);
1650 if (ret != 1) {
1651 dev_warn(&client->dev, "i2c wr failed=%d\n", ret);
1652 if (ret >= 0)
1653 ret = -EREMOTEIO;
1654 return ret;
1655 }
1656
1657 return 0;
1658 }
1659
1660
1661
1662
1663
1664
1665 struct dvb_frontend *m88ds3103_attach(const struct m88ds3103_config *cfg,
1666 struct i2c_adapter *i2c,
1667 struct i2c_adapter **tuner_i2c_adapter)
1668 {
1669 struct i2c_client *client;
1670 struct i2c_board_info board_info;
1671 struct m88ds3103_platform_data pdata = {};
1672
1673 pdata.clk = cfg->clock;
1674 pdata.i2c_wr_max = cfg->i2c_wr_max;
1675 pdata.ts_mode = cfg->ts_mode;
1676 pdata.ts_clk = cfg->ts_clk;
1677 pdata.ts_clk_pol = cfg->ts_clk_pol;
1678 pdata.spec_inv = cfg->spec_inv;
1679 pdata.agc = cfg->agc;
1680 pdata.agc_inv = cfg->agc_inv;
1681 pdata.clk_out = cfg->clock_out;
1682 pdata.envelope_mode = cfg->envelope_mode;
1683 pdata.lnb_hv_pol = cfg->lnb_hv_pol;
1684 pdata.lnb_en_pol = cfg->lnb_en_pol;
1685 pdata.attach_in_use = true;
1686
1687 memset(&board_info, 0, sizeof(board_info));
1688 strscpy(board_info.type, "m88ds3103", I2C_NAME_SIZE);
1689 board_info.addr = cfg->i2c_addr;
1690 board_info.platform_data = &pdata;
1691 client = i2c_new_client_device(i2c, &board_info);
1692 if (!i2c_client_has_driver(client))
1693 return NULL;
1694
1695 *tuner_i2c_adapter = pdata.get_i2c_adapter(client);
1696 return pdata.get_dvb_frontend(client);
1697 }
1698 EXPORT_SYMBOL(m88ds3103_attach);
1699
1700 static const struct dvb_frontend_ops m88ds3103_ops = {
1701 .delsys = {SYS_DVBS, SYS_DVBS2},
1702 .info = {
1703 .name = "Montage Technology M88DS3103",
1704 .frequency_min_hz = 950 * MHz,
1705 .frequency_max_hz = 2150 * MHz,
1706 .frequency_tolerance_hz = 5 * MHz,
1707 .symbol_rate_min = 1000000,
1708 .symbol_rate_max = 45000000,
1709 .caps = FE_CAN_INVERSION_AUTO |
1710 FE_CAN_FEC_1_2 |
1711 FE_CAN_FEC_2_3 |
1712 FE_CAN_FEC_3_4 |
1713 FE_CAN_FEC_4_5 |
1714 FE_CAN_FEC_5_6 |
1715 FE_CAN_FEC_6_7 |
1716 FE_CAN_FEC_7_8 |
1717 FE_CAN_FEC_8_9 |
1718 FE_CAN_FEC_AUTO |
1719 FE_CAN_QPSK |
1720 FE_CAN_RECOVER |
1721 FE_CAN_2G_MODULATION
1722 },
1723
1724 .release = m88ds3103_release,
1725
1726 .get_tune_settings = m88ds3103_get_tune_settings,
1727
1728 .init = m88ds3103_init,
1729 .sleep = m88ds3103_sleep,
1730
1731 .set_frontend = m88ds3103_set_frontend,
1732 .get_frontend = m88ds3103_get_frontend,
1733
1734 .read_status = m88ds3103_read_status,
1735 .read_snr = m88ds3103_read_snr,
1736 .read_ber = m88ds3103_read_ber,
1737
1738 .diseqc_send_master_cmd = m88ds3103_diseqc_send_master_cmd,
1739 .diseqc_send_burst = m88ds3103_diseqc_send_burst,
1740
1741 .set_tone = m88ds3103_set_tone,
1742 .set_voltage = m88ds3103_set_voltage,
1743 };
1744
1745 static struct dvb_frontend *m88ds3103_get_dvb_frontend(struct i2c_client *client)
1746 {
1747 struct m88ds3103_dev *dev = i2c_get_clientdata(client);
1748
1749 dev_dbg(&client->dev, "\n");
1750
1751 return &dev->fe;
1752 }
1753
1754 static struct i2c_adapter *m88ds3103_get_i2c_adapter(struct i2c_client *client)
1755 {
1756 struct m88ds3103_dev *dev = i2c_get_clientdata(client);
1757
1758 dev_dbg(&client->dev, "\n");
1759
1760 return dev->muxc->adapter[0];
1761 }
1762
1763 static int m88ds3103_probe(struct i2c_client *client,
1764 const struct i2c_device_id *id)
1765 {
1766 struct m88ds3103_dev *dev;
1767 struct m88ds3103_platform_data *pdata = client->dev.platform_data;
1768 int ret;
1769 unsigned int utmp;
1770
1771 dev = kzalloc(sizeof(*dev), GFP_KERNEL);
1772 if (!dev) {
1773 ret = -ENOMEM;
1774 goto err;
1775 }
1776
1777 dev->client = client;
1778 dev->config.clock = pdata->clk;
1779 dev->config.i2c_wr_max = pdata->i2c_wr_max;
1780 dev->config.ts_mode = pdata->ts_mode;
1781 dev->config.ts_clk = pdata->ts_clk * 1000;
1782 dev->config.ts_clk_pol = pdata->ts_clk_pol;
1783 dev->config.spec_inv = pdata->spec_inv;
1784 dev->config.agc_inv = pdata->agc_inv;
1785 dev->config.clock_out = pdata->clk_out;
1786 dev->config.envelope_mode = pdata->envelope_mode;
1787 dev->config.agc = pdata->agc;
1788 dev->config.lnb_hv_pol = pdata->lnb_hv_pol;
1789 dev->config.lnb_en_pol = pdata->lnb_en_pol;
1790 dev->cfg = &dev->config;
1791
1792 dev->regmap_config.reg_bits = 8;
1793 dev->regmap_config.val_bits = 8;
1794 dev->regmap_config.lock_arg = dev;
1795 dev->regmap = devm_regmap_init_i2c(client, &dev->regmap_config);
1796 if (IS_ERR(dev->regmap)) {
1797 ret = PTR_ERR(dev->regmap);
1798 goto err_kfree;
1799 }
1800
1801
1802 ret = regmap_read(dev->regmap, 0x00, &utmp);
1803 if (ret)
1804 goto err_kfree;
1805
1806 dev->chip_id = utmp >> 1;
1807 dev->chiptype = (u8)id->driver_data;
1808
1809 dev_dbg(&client->dev, "chip_id=%02x\n", dev->chip_id);
1810
1811 switch (dev->chip_id) {
1812 case M88RS6000_CHIP_ID:
1813 case M88DS3103_CHIP_ID:
1814 break;
1815 default:
1816 ret = -ENODEV;
1817 dev_err(&client->dev, "Unknown device. Chip_id=%02x\n", dev->chip_id);
1818 goto err_kfree;
1819 }
1820
1821 switch (dev->cfg->clock_out) {
1822 case M88DS3103_CLOCK_OUT_DISABLED:
1823 utmp = 0x80;
1824 break;
1825 case M88DS3103_CLOCK_OUT_ENABLED:
1826 utmp = 0x00;
1827 break;
1828 case M88DS3103_CLOCK_OUT_ENABLED_DIV2:
1829 utmp = 0x10;
1830 break;
1831 default:
1832 ret = -EINVAL;
1833 goto err_kfree;
1834 }
1835
1836 if (!pdata->ts_clk) {
1837 ret = -EINVAL;
1838 goto err_kfree;
1839 }
1840
1841
1842
1843 if (dev->chip_id == M88RS6000_CHIP_ID)
1844 utmp = 0x00;
1845
1846 ret = regmap_write(dev->regmap, 0x29, utmp);
1847 if (ret)
1848 goto err_kfree;
1849
1850
1851 ret = m88ds3103_update_bits(dev, 0x08, 0x01, 0x00);
1852 if (ret)
1853 goto err_kfree;
1854 ret = m88ds3103_update_bits(dev, 0x04, 0x01, 0x01);
1855 if (ret)
1856 goto err_kfree;
1857 ret = m88ds3103_update_bits(dev, 0x23, 0x10, 0x10);
1858 if (ret)
1859 goto err_kfree;
1860
1861
1862 dev->muxc = i2c_mux_alloc(client->adapter, &client->dev, 1, 0, 0,
1863 m88ds3103_select, NULL);
1864 if (!dev->muxc) {
1865 ret = -ENOMEM;
1866 goto err_kfree;
1867 }
1868 dev->muxc->priv = dev;
1869 ret = i2c_mux_add_adapter(dev->muxc, 0, 0, 0);
1870 if (ret)
1871 goto err_kfree;
1872
1873
1874 memcpy(&dev->fe.ops, &m88ds3103_ops, sizeof(struct dvb_frontend_ops));
1875 if (dev->chiptype == M88DS3103_CHIPTYPE_3103B)
1876 strscpy(dev->fe.ops.info.name, "Montage Technology M88DS3103B",
1877 sizeof(dev->fe.ops.info.name));
1878 else if (dev->chip_id == M88RS6000_CHIP_ID)
1879 strscpy(dev->fe.ops.info.name, "Montage Technology M88RS6000",
1880 sizeof(dev->fe.ops.info.name));
1881 if (!pdata->attach_in_use)
1882 dev->fe.ops.release = NULL;
1883 dev->fe.demodulator_priv = dev;
1884 i2c_set_clientdata(client, dev);
1885
1886
1887 pdata->get_dvb_frontend = m88ds3103_get_dvb_frontend;
1888 pdata->get_i2c_adapter = m88ds3103_get_i2c_adapter;
1889
1890 if (dev->chiptype == M88DS3103_CHIPTYPE_3103B) {
1891
1892 m88ds3103_update_bits(dev, 0x11, 0x01, 0x01);
1893
1894
1895 ret = regmap_read(dev->regmap, 0x29, &utmp);
1896 if (ret)
1897 goto err_kfree;
1898 dev->dt_addr = ((utmp & 0x80) == 0) ? 0x42 >> 1 : 0x40 >> 1;
1899 dev_dbg(&client->dev, "dt addr is 0x%02x\n", dev->dt_addr);
1900
1901 dev->dt_client = i2c_new_dummy_device(client->adapter,
1902 dev->dt_addr);
1903 if (IS_ERR(dev->dt_client)) {
1904 ret = PTR_ERR(dev->dt_client);
1905 goto err_kfree;
1906 }
1907 }
1908
1909 return 0;
1910 err_kfree:
1911 kfree(dev);
1912 err:
1913 dev_dbg(&client->dev, "failed=%d\n", ret);
1914 return ret;
1915 }
1916
1917 static int m88ds3103_remove(struct i2c_client *client)
1918 {
1919 struct m88ds3103_dev *dev = i2c_get_clientdata(client);
1920
1921 dev_dbg(&client->dev, "\n");
1922
1923 if (dev->dt_client)
1924 i2c_unregister_device(dev->dt_client);
1925
1926 i2c_mux_del_adapters(dev->muxc);
1927
1928 kfree(dev);
1929 return 0;
1930 }
1931
1932 static const struct i2c_device_id m88ds3103_id_table[] = {
1933 {"m88ds3103", M88DS3103_CHIPTYPE_3103},
1934 {"m88rs6000", M88DS3103_CHIPTYPE_RS6000},
1935 {"m88ds3103b", M88DS3103_CHIPTYPE_3103B},
1936 {}
1937 };
1938 MODULE_DEVICE_TABLE(i2c, m88ds3103_id_table);
1939
1940 static struct i2c_driver m88ds3103_driver = {
1941 .driver = {
1942 .name = "m88ds3103",
1943 .suppress_bind_attrs = true,
1944 },
1945 .probe = m88ds3103_probe,
1946 .remove = m88ds3103_remove,
1947 .id_table = m88ds3103_id_table,
1948 };
1949
1950 module_i2c_driver(m88ds3103_driver);
1951
1952 MODULE_AUTHOR("Antti Palosaari <crope@iki.fi>");
1953 MODULE_DESCRIPTION("Montage Technology M88DS3103 DVB-S/S2 demodulator driver");
1954 MODULE_LICENSE("GPL");
1955 MODULE_FIRMWARE(M88DS3103_FIRMWARE);
1956 MODULE_FIRMWARE(M88RS6000_FIRMWARE);
1957 MODULE_FIRMWARE(M88DS3103B_FIRMWARE);