1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * Driver for the internal tuner of Montage M88RS6000
4 *
5 * Copyright (C) 2014 Max nibble <nibble.max@gmail.com>
6 */
7
8 #include "m88rs6000t.h"
9 #include <linux/regmap.h>
10
11 struct m88rs6000t_dev {
12 struct m88rs6000t_config cfg;
13 struct i2c_client *client;
14 struct regmap *regmap;
15 u32 frequency_khz;
16 };
17
18 struct m88rs6000t_reg_val {
19 u8 reg;
20 u8 val;
21 };
22
23 /* set demod main mclk and ts mclk */
m88rs6000t_set_demod_mclk(struct dvb_frontend * fe)24 static int m88rs6000t_set_demod_mclk(struct dvb_frontend *fe)
25 {
26 struct m88rs6000t_dev *dev = fe->tuner_priv;
27 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
28 u8 reg11, reg15, reg16, reg1D, reg1E, reg1F;
29 u8 N, f0 = 0, f1 = 0, f2 = 0, f3 = 0;
30 u16 pll_div_fb;
31 u32 div, ts_mclk;
32 unsigned int utmp;
33 int ret;
34
35 /* select demod main mclk */
36 ret = regmap_read(dev->regmap, 0x15, &utmp);
37 if (ret)
38 goto err;
39 reg15 = utmp;
40 if (c->symbol_rate > 45010000) {
41 reg11 = 0x0E;
42 reg15 |= 0x02;
43 reg16 = 115; /* mclk = 110.25MHz */
44 } else {
45 reg11 = 0x0A;
46 reg15 &= ~0x02;
47 reg16 = 96; /* mclk = 96MHz */
48 }
49
50 /* set ts mclk */
51 if (c->delivery_system == SYS_DVBS)
52 ts_mclk = 96000;
53 else
54 ts_mclk = 144000;
55
56 pll_div_fb = (reg15 & 0x01) << 8;
57 pll_div_fb += reg16;
58 pll_div_fb += 32;
59
60 div = 36000 * pll_div_fb;
61 div /= ts_mclk;
62
63 if (div <= 32) {
64 N = 2;
65 f0 = 0;
66 f1 = div / 2;
67 f2 = div - f1;
68 f3 = 0;
69 } else if (div <= 48) {
70 N = 3;
71 f0 = div / 3;
72 f1 = (div - f0) / 2;
73 f2 = div - f0 - f1;
74 f3 = 0;
75 } else if (div <= 64) {
76 N = 4;
77 f0 = div / 4;
78 f1 = (div - f0) / 3;
79 f2 = (div - f0 - f1) / 2;
80 f3 = div - f0 - f1 - f2;
81 } else {
82 N = 4;
83 f0 = 16;
84 f1 = 16;
85 f2 = 16;
86 f3 = 16;
87 }
88
89 if (f0 == 16)
90 f0 = 0;
91 if (f1 == 16)
92 f1 = 0;
93 if (f2 == 16)
94 f2 = 0;
95 if (f3 == 16)
96 f3 = 0;
97
98 ret = regmap_read(dev->regmap, 0x1D, &utmp);
99 if (ret)
100 goto err;
101 reg1D = utmp;
102 reg1D &= ~0x03;
103 reg1D |= N - 1;
104 reg1E = ((f3 << 4) + f2) & 0xFF;
105 reg1F = ((f1 << 4) + f0) & 0xFF;
106
107 /* program and recalibrate demod PLL */
108 ret = regmap_write(dev->regmap, 0x05, 0x40);
109 if (ret)
110 goto err;
111 ret = regmap_write(dev->regmap, 0x11, 0x08);
112 if (ret)
113 goto err;
114 ret = regmap_write(dev->regmap, 0x15, reg15);
115 if (ret)
116 goto err;
117 ret = regmap_write(dev->regmap, 0x16, reg16);
118 if (ret)
119 goto err;
120 ret = regmap_write(dev->regmap, 0x1D, reg1D);
121 if (ret)
122 goto err;
123 ret = regmap_write(dev->regmap, 0x1E, reg1E);
124 if (ret)
125 goto err;
126 ret = regmap_write(dev->regmap, 0x1F, reg1F);
127 if (ret)
128 goto err;
129 ret = regmap_write(dev->regmap, 0x17, 0xc1);
130 if (ret)
131 goto err;
132 ret = regmap_write(dev->regmap, 0x17, 0x81);
133 if (ret)
134 goto err;
135 usleep_range(5000, 50000);
136 ret = regmap_write(dev->regmap, 0x05, 0x00);
137 if (ret)
138 goto err;
139 ret = regmap_write(dev->regmap, 0x11, reg11);
140 if (ret)
141 goto err;
142 usleep_range(5000, 50000);
143 err:
144 if (ret)
145 dev_dbg(&dev->client->dev, "failed=%d\n", ret);
146 return ret;
147 }
148
m88rs6000t_set_pll_freq(struct m88rs6000t_dev * dev,u32 tuner_freq_MHz)149 static int m88rs6000t_set_pll_freq(struct m88rs6000t_dev *dev,
150 u32 tuner_freq_MHz)
151 {
152 u32 fcry_KHz, ulNDiv1, ulNDiv2, ulNDiv;
153 u8 refDiv, ucLoDiv1, ucLomod1, ucLoDiv2, ucLomod2, ucLoDiv, ucLomod;
154 u8 reg27, reg29, reg42, reg42buf;
155 unsigned int utmp;
156 int ret;
157
158 fcry_KHz = 27000; /* in kHz */
159 refDiv = 27;
160
161 ret = regmap_write(dev->regmap, 0x36, (refDiv - 8));
162 if (ret)
163 goto err;
164 ret = regmap_write(dev->regmap, 0x31, 0x00);
165 if (ret)
166 goto err;
167 ret = regmap_write(dev->regmap, 0x2c, 0x02);
168 if (ret)
169 goto err;
170
171 if (tuner_freq_MHz >= 1550) {
172 ucLoDiv1 = 2;
173 ucLomod1 = 0;
174 ucLoDiv2 = 2;
175 ucLomod2 = 0;
176 } else if (tuner_freq_MHz >= 1380) {
177 ucLoDiv1 = 3;
178 ucLomod1 = 16;
179 ucLoDiv2 = 2;
180 ucLomod2 = 0;
181 } else if (tuner_freq_MHz >= 1070) {
182 ucLoDiv1 = 3;
183 ucLomod1 = 16;
184 ucLoDiv2 = 3;
185 ucLomod2 = 16;
186 } else if (tuner_freq_MHz >= 1000) {
187 ucLoDiv1 = 3;
188 ucLomod1 = 16;
189 ucLoDiv2 = 4;
190 ucLomod2 = 64;
191 } else if (tuner_freq_MHz >= 775) {
192 ucLoDiv1 = 4;
193 ucLomod1 = 64;
194 ucLoDiv2 = 4;
195 ucLomod2 = 64;
196 } else if (tuner_freq_MHz >= 700) {
197 ucLoDiv1 = 6;
198 ucLomod1 = 48;
199 ucLoDiv2 = 4;
200 ucLomod2 = 64;
201 } else if (tuner_freq_MHz >= 520) {
202 ucLoDiv1 = 6;
203 ucLomod1 = 48;
204 ucLoDiv2 = 6;
205 ucLomod2 = 48;
206 } else {
207 ucLoDiv1 = 8;
208 ucLomod1 = 96;
209 ucLoDiv2 = 8;
210 ucLomod2 = 96;
211 }
212
213 ulNDiv1 = ((tuner_freq_MHz * ucLoDiv1 * 1000) * refDiv
214 / fcry_KHz - 1024) / 2;
215 ulNDiv2 = ((tuner_freq_MHz * ucLoDiv2 * 1000) * refDiv
216 / fcry_KHz - 1024) / 2;
217
218 reg27 = (((ulNDiv1 >> 8) & 0x0F) + ucLomod1) & 0x7F;
219 ret = regmap_write(dev->regmap, 0x27, reg27);
220 if (ret)
221 goto err;
222 ret = regmap_write(dev->regmap, 0x28, (u8)(ulNDiv1 & 0xFF));
223 if (ret)
224 goto err;
225 reg29 = (((ulNDiv2 >> 8) & 0x0F) + ucLomod2) & 0x7f;
226 ret = regmap_write(dev->regmap, 0x29, reg29);
227 if (ret)
228 goto err;
229 ret = regmap_write(dev->regmap, 0x2a, (u8)(ulNDiv2 & 0xFF));
230 if (ret)
231 goto err;
232 ret = regmap_write(dev->regmap, 0x2F, 0xf5);
233 if (ret)
234 goto err;
235 ret = regmap_write(dev->regmap, 0x30, 0x05);
236 if (ret)
237 goto err;
238 ret = regmap_write(dev->regmap, 0x08, 0x1f);
239 if (ret)
240 goto err;
241 ret = regmap_write(dev->regmap, 0x08, 0x3f);
242 if (ret)
243 goto err;
244 ret = regmap_write(dev->regmap, 0x09, 0x20);
245 if (ret)
246 goto err;
247 ret = regmap_write(dev->regmap, 0x09, 0x00);
248 if (ret)
249 goto err;
250 ret = regmap_write(dev->regmap, 0x3e, 0x11);
251 if (ret)
252 goto err;
253 ret = regmap_write(dev->regmap, 0x08, 0x2f);
254 if (ret)
255 goto err;
256 ret = regmap_write(dev->regmap, 0x08, 0x3f);
257 if (ret)
258 goto err;
259 ret = regmap_write(dev->regmap, 0x09, 0x10);
260 if (ret)
261 goto err;
262 ret = regmap_write(dev->regmap, 0x09, 0x00);
263 if (ret)
264 goto err;
265 usleep_range(2000, 50000);
266
267 ret = regmap_read(dev->regmap, 0x42, &utmp);
268 if (ret)
269 goto err;
270 reg42 = utmp;
271
272 ret = regmap_write(dev->regmap, 0x3e, 0x10);
273 if (ret)
274 goto err;
275 ret = regmap_write(dev->regmap, 0x08, 0x2f);
276 if (ret)
277 goto err;
278 ret = regmap_write(dev->regmap, 0x08, 0x3f);
279 if (ret)
280 goto err;
281 ret = regmap_write(dev->regmap, 0x09, 0x10);
282 if (ret)
283 goto err;
284 ret = regmap_write(dev->regmap, 0x09, 0x00);
285 if (ret)
286 goto err;
287 usleep_range(2000, 50000);
288
289 ret = regmap_read(dev->regmap, 0x42, &utmp);
290 if (ret)
291 goto err;
292 reg42buf = utmp;
293 if (reg42buf < reg42) {
294 ret = regmap_write(dev->regmap, 0x3e, 0x11);
295 if (ret)
296 goto err;
297 }
298 usleep_range(5000, 50000);
299
300 ret = regmap_read(dev->regmap, 0x2d, &utmp);
301 if (ret)
302 goto err;
303 ret = regmap_write(dev->regmap, 0x2d, utmp);
304 if (ret)
305 goto err;
306 ret = regmap_read(dev->regmap, 0x2e, &utmp);
307 if (ret)
308 goto err;
309 ret = regmap_write(dev->regmap, 0x2e, utmp);
310 if (ret)
311 goto err;
312
313 ret = regmap_read(dev->regmap, 0x27, &utmp);
314 if (ret)
315 goto err;
316 reg27 = utmp & 0x70;
317 ret = regmap_read(dev->regmap, 0x83, &utmp);
318 if (ret)
319 goto err;
320 if (reg27 == (utmp & 0x70)) {
321 ucLoDiv = ucLoDiv1;
322 ulNDiv = ulNDiv1;
323 ucLomod = ucLomod1 / 16;
324 } else {
325 ucLoDiv = ucLoDiv2;
326 ulNDiv = ulNDiv2;
327 ucLomod = ucLomod2 / 16;
328 }
329
330 if ((ucLoDiv == 3) || (ucLoDiv == 6)) {
331 refDiv = 18;
332 ret = regmap_write(dev->regmap, 0x36, (refDiv - 8));
333 if (ret)
334 goto err;
335 ulNDiv = ((tuner_freq_MHz * ucLoDiv * 1000) * refDiv
336 / fcry_KHz - 1024) / 2;
337 }
338
339 reg27 = (0x80 + ((ucLomod << 4) & 0x70)
340 + ((ulNDiv >> 8) & 0x0F)) & 0xFF;
341 ret = regmap_write(dev->regmap, 0x27, reg27);
342 if (ret)
343 goto err;
344 ret = regmap_write(dev->regmap, 0x28, (u8)(ulNDiv & 0xFF));
345 if (ret)
346 goto err;
347 ret = regmap_write(dev->regmap, 0x29, 0x80);
348 if (ret)
349 goto err;
350 ret = regmap_write(dev->regmap, 0x31, 0x03);
351 if (ret)
352 goto err;
353
354 if (ucLoDiv == 3)
355 utmp = 0xCE;
356 else
357 utmp = 0x8A;
358 ret = regmap_write(dev->regmap, 0x3b, utmp);
359 if (ret)
360 goto err;
361
362 dev->frequency_khz = fcry_KHz * (ulNDiv * 2 + 1024) / refDiv / ucLoDiv;
363
364 dev_dbg(&dev->client->dev,
365 "actual tune frequency=%d\n", dev->frequency_khz);
366 err:
367 if (ret)
368 dev_dbg(&dev->client->dev, "failed=%d\n", ret);
369 return ret;
370 }
371
m88rs6000t_set_bb(struct m88rs6000t_dev * dev,u32 symbol_rate_KSs,s32 lpf_offset_KHz)372 static int m88rs6000t_set_bb(struct m88rs6000t_dev *dev,
373 u32 symbol_rate_KSs, s32 lpf_offset_KHz)
374 {
375 u32 f3dB;
376 u8 reg40;
377
378 f3dB = symbol_rate_KSs * 9 / 14 + 2000;
379 f3dB += lpf_offset_KHz;
380 f3dB = clamp_val(f3dB, 6000U, 43000U);
381 reg40 = f3dB / 1000;
382 return regmap_write(dev->regmap, 0x40, reg40);
383 }
384
m88rs6000t_set_params(struct dvb_frontend * fe)385 static int m88rs6000t_set_params(struct dvb_frontend *fe)
386 {
387 struct m88rs6000t_dev *dev = fe->tuner_priv;
388 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
389 int ret;
390 s32 lpf_offset_KHz;
391 u32 realFreq, freq_MHz;
392
393 dev_dbg(&dev->client->dev,
394 "frequency=%d symbol_rate=%d\n",
395 c->frequency, c->symbol_rate);
396
397 if (c->symbol_rate < 5000000)
398 lpf_offset_KHz = 3000;
399 else
400 lpf_offset_KHz = 0;
401
402 realFreq = c->frequency + lpf_offset_KHz;
403 /* set tuner pll.*/
404 freq_MHz = (realFreq + 500) / 1000;
405 ret = m88rs6000t_set_pll_freq(dev, freq_MHz);
406 if (ret)
407 goto err;
408 ret = m88rs6000t_set_bb(dev, c->symbol_rate / 1000, lpf_offset_KHz);
409 if (ret)
410 goto err;
411 ret = regmap_write(dev->regmap, 0x00, 0x01);
412 if (ret)
413 goto err;
414 ret = regmap_write(dev->regmap, 0x00, 0x00);
415 if (ret)
416 goto err;
417 /* set demod mlck */
418 ret = m88rs6000t_set_demod_mclk(fe);
419 err:
420 if (ret)
421 dev_dbg(&dev->client->dev, "failed=%d\n", ret);
422 return ret;
423 }
424
m88rs6000t_init(struct dvb_frontend * fe)425 static int m88rs6000t_init(struct dvb_frontend *fe)
426 {
427 struct m88rs6000t_dev *dev = fe->tuner_priv;
428 int ret;
429
430 dev_dbg(&dev->client->dev, "%s:\n", __func__);
431
432 ret = regmap_update_bits(dev->regmap, 0x11, 0x08, 0x08);
433 if (ret)
434 goto err;
435 usleep_range(5000, 50000);
436 ret = regmap_update_bits(dev->regmap, 0x10, 0x01, 0x01);
437 if (ret)
438 goto err;
439 usleep_range(10000, 50000);
440 ret = regmap_write(dev->regmap, 0x07, 0x7d);
441 err:
442 if (ret)
443 dev_dbg(&dev->client->dev, "failed=%d\n", ret);
444 return ret;
445 }
446
m88rs6000t_sleep(struct dvb_frontend * fe)447 static int m88rs6000t_sleep(struct dvb_frontend *fe)
448 {
449 struct m88rs6000t_dev *dev = fe->tuner_priv;
450 int ret;
451
452 dev_dbg(&dev->client->dev, "%s:\n", __func__);
453
454 ret = regmap_write(dev->regmap, 0x07, 0x6d);
455 if (ret) {
456 dev_dbg(&dev->client->dev, "failed=%d\n", ret);
457 return ret;
458 }
459 usleep_range(5000, 10000);
460 return 0;
461 }
462
m88rs6000t_get_frequency(struct dvb_frontend * fe,u32 * frequency)463 static int m88rs6000t_get_frequency(struct dvb_frontend *fe, u32 *frequency)
464 {
465 struct m88rs6000t_dev *dev = fe->tuner_priv;
466
467 dev_dbg(&dev->client->dev, "\n");
468
469 *frequency = dev->frequency_khz;
470 return 0;
471 }
472
m88rs6000t_get_if_frequency(struct dvb_frontend * fe,u32 * frequency)473 static int m88rs6000t_get_if_frequency(struct dvb_frontend *fe, u32 *frequency)
474 {
475 struct m88rs6000t_dev *dev = fe->tuner_priv;
476
477 dev_dbg(&dev->client->dev, "\n");
478
479 *frequency = 0; /* Zero-IF */
480 return 0;
481 }
482
483
m88rs6000t_get_rf_strength(struct dvb_frontend * fe,u16 * strength)484 static int m88rs6000t_get_rf_strength(struct dvb_frontend *fe, u16 *strength)
485 {
486 struct m88rs6000t_dev *dev = fe->tuner_priv;
487 unsigned int val, i;
488 int ret;
489 u16 gain;
490 u32 PGA2_cri_GS = 46, PGA2_crf_GS = 290, TIA_GS = 290;
491 u32 RF_GC = 1200, IF_GC = 1100, BB_GC = 300;
492 u32 PGA2_GC = 300, TIA_GC = 300, PGA2_cri = 0, PGA2_crf = 0;
493 u32 RFG = 0, IFG = 0, BBG = 0, PGA2G = 0, TIAG = 0;
494 u32 RFGS[13] = {0, 245, 266, 268, 270, 285,
495 298, 295, 283, 285, 285, 300, 300};
496 u32 IFGS[12] = {0, 300, 230, 270, 270, 285,
497 295, 285, 290, 295, 295, 310};
498 u32 BBGS[14] = {0, 286, 275, 290, 294, 300, 290,
499 290, 285, 283, 260, 295, 290, 260};
500
501 ret = regmap_read(dev->regmap, 0x5A, &val);
502 if (ret)
503 goto err;
504 RF_GC = val & 0x0f;
505
506 ret = regmap_read(dev->regmap, 0x5F, &val);
507 if (ret)
508 goto err;
509 IF_GC = val & 0x0f;
510
511 ret = regmap_read(dev->regmap, 0x3F, &val);
512 if (ret)
513 goto err;
514 TIA_GC = (val >> 4) & 0x07;
515
516 ret = regmap_read(dev->regmap, 0x77, &val);
517 if (ret)
518 goto err;
519 BB_GC = (val >> 4) & 0x0f;
520
521 ret = regmap_read(dev->regmap, 0x76, &val);
522 if (ret)
523 goto err;
524 PGA2_GC = val & 0x3f;
525 PGA2_cri = PGA2_GC >> 2;
526 PGA2_crf = PGA2_GC & 0x03;
527
528 for (i = 0; i <= RF_GC && i < ARRAY_SIZE(RFGS); i++)
529 RFG += RFGS[i];
530
531 if (RF_GC == 0)
532 RFG += 400;
533 if (RF_GC == 1)
534 RFG += 300;
535 if (RF_GC == 2)
536 RFG += 200;
537 if (RF_GC == 3)
538 RFG += 100;
539
540 for (i = 0; i <= IF_GC && i < ARRAY_SIZE(IFGS); i++)
541 IFG += IFGS[i];
542
543 TIAG = TIA_GC * TIA_GS;
544
545 for (i = 0; i <= BB_GC && i < ARRAY_SIZE(BBGS); i++)
546 BBG += BBGS[i];
547
548 PGA2G = PGA2_cri * PGA2_cri_GS + PGA2_crf * PGA2_crf_GS;
549
550 gain = RFG + IFG - TIAG + BBG + PGA2G;
551
552 /* scale value to 0x0000-0xffff */
553 gain = clamp_val(gain, 1000U, 10500U);
554 *strength = (10500 - gain) * 0xffff / (10500 - 1000);
555 err:
556 if (ret)
557 dev_dbg(&dev->client->dev, "failed=%d\n", ret);
558 return ret;
559 }
560
561 static const struct dvb_tuner_ops m88rs6000t_tuner_ops = {
562 .info = {
563 .name = "Montage M88RS6000 Internal Tuner",
564 .frequency_min_hz = 950 * MHz,
565 .frequency_max_hz = 2150 * MHz,
566 },
567
568 .init = m88rs6000t_init,
569 .sleep = m88rs6000t_sleep,
570 .set_params = m88rs6000t_set_params,
571 .get_frequency = m88rs6000t_get_frequency,
572 .get_if_frequency = m88rs6000t_get_if_frequency,
573 .get_rf_strength = m88rs6000t_get_rf_strength,
574 };
575
m88rs6000t_probe(struct i2c_client * client)576 static int m88rs6000t_probe(struct i2c_client *client)
577 {
578 struct m88rs6000t_config *cfg = client->dev.platform_data;
579 struct dvb_frontend *fe = cfg->fe;
580 struct m88rs6000t_dev *dev;
581 int ret, i;
582 unsigned int utmp;
583 static const struct regmap_config regmap_config = {
584 .reg_bits = 8,
585 .val_bits = 8,
586 };
587 static const struct m88rs6000t_reg_val reg_vals[] = {
588 {0x10, 0xfb},
589 {0x24, 0x38},
590 {0x11, 0x0a},
591 {0x12, 0x00},
592 {0x2b, 0x1c},
593 {0x44, 0x48},
594 {0x54, 0x24},
595 {0x55, 0x06},
596 {0x59, 0x00},
597 {0x5b, 0x4c},
598 {0x60, 0x8b},
599 {0x61, 0xf4},
600 {0x65, 0x07},
601 {0x6d, 0x6f},
602 {0x6e, 0x31},
603 {0x3c, 0xf3},
604 {0x37, 0x0f},
605 {0x48, 0x28},
606 {0x49, 0xd8},
607 {0x70, 0x66},
608 {0x71, 0xCF},
609 {0x72, 0x81},
610 {0x73, 0xA7},
611 {0x74, 0x4F},
612 {0x75, 0xFC},
613 };
614
615 dev = kzalloc(sizeof(*dev), GFP_KERNEL);
616 if (!dev) {
617 ret = -ENOMEM;
618 dev_err(&client->dev, "kzalloc() failed\n");
619 goto err;
620 }
621
622 memcpy(&dev->cfg, cfg, sizeof(struct m88rs6000t_config));
623 dev->client = client;
624 dev->regmap = devm_regmap_init_i2c(client, ®map_config);
625 if (IS_ERR(dev->regmap)) {
626 ret = PTR_ERR(dev->regmap);
627 goto err;
628 }
629
630 ret = regmap_update_bits(dev->regmap, 0x11, 0x08, 0x08);
631 if (ret)
632 goto err;
633 usleep_range(5000, 50000);
634 ret = regmap_update_bits(dev->regmap, 0x10, 0x01, 0x01);
635 if (ret)
636 goto err;
637 usleep_range(10000, 50000);
638 ret = regmap_write(dev->regmap, 0x07, 0x7d);
639 if (ret)
640 goto err;
641 ret = regmap_write(dev->regmap, 0x04, 0x01);
642 if (ret)
643 goto err;
644
645 /* check tuner chip id */
646 ret = regmap_read(dev->regmap, 0x01, &utmp);
647 if (ret)
648 goto err;
649 dev_info(&dev->client->dev, "chip_id=%02x\n", utmp);
650 if (utmp != 0x64) {
651 ret = -ENODEV;
652 goto err;
653 }
654
655 /* tuner init. */
656 ret = regmap_write(dev->regmap, 0x05, 0x40);
657 if (ret)
658 goto err;
659 ret = regmap_write(dev->regmap, 0x11, 0x08);
660 if (ret)
661 goto err;
662 ret = regmap_write(dev->regmap, 0x15, 0x6c);
663 if (ret)
664 goto err;
665 ret = regmap_write(dev->regmap, 0x17, 0xc1);
666 if (ret)
667 goto err;
668 ret = regmap_write(dev->regmap, 0x17, 0x81);
669 if (ret)
670 goto err;
671 usleep_range(10000, 50000);
672 ret = regmap_write(dev->regmap, 0x05, 0x00);
673 if (ret)
674 goto err;
675 ret = regmap_write(dev->regmap, 0x11, 0x0a);
676 if (ret)
677 goto err;
678
679 for (i = 0; i < ARRAY_SIZE(reg_vals); i++) {
680 ret = regmap_write(dev->regmap,
681 reg_vals[i].reg, reg_vals[i].val);
682 if (ret)
683 goto err;
684 }
685
686 dev_info(&dev->client->dev, "Montage M88RS6000 internal tuner successfully identified\n");
687
688 fe->tuner_priv = dev;
689 memcpy(&fe->ops.tuner_ops, &m88rs6000t_tuner_ops,
690 sizeof(struct dvb_tuner_ops));
691 i2c_set_clientdata(client, dev);
692 return 0;
693 err:
694 dev_dbg(&client->dev, "failed=%d\n", ret);
695 kfree(dev);
696 return ret;
697 }
698
m88rs6000t_remove(struct i2c_client * client)699 static void m88rs6000t_remove(struct i2c_client *client)
700 {
701 struct m88rs6000t_dev *dev = i2c_get_clientdata(client);
702 struct dvb_frontend *fe = dev->cfg.fe;
703
704 dev_dbg(&client->dev, "\n");
705
706 memset(&fe->ops.tuner_ops, 0, sizeof(struct dvb_tuner_ops));
707 fe->tuner_priv = NULL;
708 kfree(dev);
709 }
710
711 static const struct i2c_device_id m88rs6000t_id[] = {
712 { "m88rs6000t" },
713 {}
714 };
715 MODULE_DEVICE_TABLE(i2c, m88rs6000t_id);
716
717 static struct i2c_driver m88rs6000t_driver = {
718 .driver = {
719 .name = "m88rs6000t",
720 },
721 .probe = m88rs6000t_probe,
722 .remove = m88rs6000t_remove,
723 .id_table = m88rs6000t_id,
724 };
725
726 module_i2c_driver(m88rs6000t_driver);
727
728 MODULE_AUTHOR("Max nibble <nibble.max@gmail.com>");
729 MODULE_DESCRIPTION("Montage M88RS6000 internal tuner driver");
730 MODULE_LICENSE("GPL");
731