?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
drm/tests: hdmi: Fix memory leaks in drm_display_mode_from_cea_vic()
[drm/drm-misc.git] / drivers / media / tuners / qt1010.c
blob48fc79cd402733aec6d3fdef8a99eb2327cd9eee
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * Driver for Quantek QT1010 silicon tuner
4 *
5 * Copyright (C) 2006 Antti Palosaari <crope@iki.fi>
6 * Aapo Tahkola <aet@rasterburn.org>
7 */
8 #include "qt1010.h"
9 #include "qt1010_priv.h"
10
11 /* read single register */
12 static int qt1010_readreg(struct qt1010_priv *priv, u8 reg, u8 *val)
13 {
14 struct i2c_msg msg[2] = {
15 { .addr = priv->cfg->i2c_address,
16 .flags = 0, .buf = &reg, .len = 1 },
17 { .addr = priv->cfg->i2c_address,
18 .flags = I2C_M_RD, .buf = val, .len = 1 },
19 };
20
21 if (i2c_transfer(priv->i2c, msg, 2) != 2) {
22 dev_warn(&priv->i2c->dev, "%s: i2c rd failed reg=%02x\n",
23 KBUILD_MODNAME, reg);
24 return -EREMOTEIO;
25 }
26 return 0;
27 }
28
29 /* write single register */
30 static int qt1010_writereg(struct qt1010_priv *priv, u8 reg, u8 val)
31 {
32 u8 buf[2] = { reg, val };
33 struct i2c_msg msg = { .addr = priv->cfg->i2c_address,
34 .flags = 0, .buf = buf, .len = 2 };
35
36 if (i2c_transfer(priv->i2c, &msg, 1) != 1) {
37 dev_warn(&priv->i2c->dev, "%s: i2c wr failed reg=%02x\n",
38 KBUILD_MODNAME, reg);
39 return -EREMOTEIO;
40 }
41 return 0;
42 }
43
44 static int qt1010_set_params(struct dvb_frontend *fe)
45 {
46 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
47 struct qt1010_priv *priv;
48 int err;
49 u32 freq, div, mod1, mod2;
50 u8 i, tmpval, reg05;
51 qt1010_i2c_oper_t rd[48] = {
52 { QT1010_WR, 0x01, 0x80 },
53 { QT1010_WR, 0x02, 0x3f },
54 { QT1010_WR, 0x05, 0xff }, /* 02 c write */
55 { QT1010_WR, 0x06, 0x44 },
56 { QT1010_WR, 0x07, 0xff }, /* 04 c write */
57 { QT1010_WR, 0x08, 0x08 },
58 { QT1010_WR, 0x09, 0xff }, /* 06 c write */
59 { QT1010_WR, 0x0a, 0xff }, /* 07 c write */
60 { QT1010_WR, 0x0b, 0xff }, /* 08 c write */
61 { QT1010_WR, 0x0c, 0xe1 },
62 { QT1010_WR, 0x1a, 0xff }, /* 10 c write */
63 { QT1010_WR, 0x1b, 0x00 },
64 { QT1010_WR, 0x1c, 0x89 },
65 { QT1010_WR, 0x11, 0xff }, /* 13 c write */
66 { QT1010_WR, 0x12, 0xff }, /* 14 c write */
67 { QT1010_WR, 0x22, 0xff }, /* 15 c write */
68 { QT1010_WR, 0x1e, 0x00 },
69 { QT1010_WR, 0x1e, 0xd0 },
70 { QT1010_RD, 0x22, 0xff }, /* 16 c read */
71 { QT1010_WR, 0x1e, 0x00 },
72 { QT1010_RD, 0x05, 0xff }, /* 20 c read */
73 { QT1010_RD, 0x22, 0xff }, /* 21 c read */
74 { QT1010_WR, 0x23, 0xd0 },
75 { QT1010_WR, 0x1e, 0x00 },
76 { QT1010_WR, 0x1e, 0xe0 },
77 { QT1010_RD, 0x23, 0xff }, /* 25 c read */
78 { QT1010_RD, 0x23, 0xff }, /* 26 c read */
79 { QT1010_WR, 0x1e, 0x00 },
80 { QT1010_WR, 0x24, 0xd0 },
81 { QT1010_WR, 0x1e, 0x00 },
82 { QT1010_WR, 0x1e, 0xf0 },
83 { QT1010_RD, 0x24, 0xff }, /* 31 c read */
84 { QT1010_WR, 0x1e, 0x00 },
85 { QT1010_WR, 0x14, 0x7f },
86 { QT1010_WR, 0x15, 0x7f },
87 { QT1010_WR, 0x05, 0xff }, /* 35 c write */
88 { QT1010_WR, 0x06, 0x00 },
89 { QT1010_WR, 0x15, 0x1f },
90 { QT1010_WR, 0x16, 0xff },
91 { QT1010_WR, 0x18, 0xff },
92 { QT1010_WR, 0x1f, 0xff }, /* 40 c write */
93 { QT1010_WR, 0x20, 0xff }, /* 41 c write */
94 { QT1010_WR, 0x21, 0x53 },
95 { QT1010_WR, 0x25, 0xff }, /* 43 c write */
96 { QT1010_WR, 0x26, 0x15 },
97 { QT1010_WR, 0x00, 0xff }, /* 45 c write */
98 { QT1010_WR, 0x02, 0x00 },
99 { QT1010_WR, 0x01, 0x00 }
100 };
101
102 #define FREQ1 32000000 /* 32 MHz */
103 #define FREQ2 4000000 /* 4 MHz Quartz oscillator in the stick? */
104
105 priv = fe->tuner_priv;
106 freq = c->frequency;
107 div = (freq + QT1010_OFFSET) / QT1010_STEP;
108 freq = (div * QT1010_STEP) - QT1010_OFFSET;
109 mod1 = (freq + QT1010_OFFSET) % FREQ1;
110 mod2 = (freq + QT1010_OFFSET) % FREQ2;
111 priv->frequency = freq;
112
113 if (fe->ops.i2c_gate_ctrl)
114 fe->ops.i2c_gate_ctrl(fe, 1); /* open i2c_gate */
115
116 /* reg 05 base value */
117 if (freq < 290000000) reg05 = 0x14; /* 290 MHz */
118 else if (freq < 610000000) reg05 = 0x34; /* 610 MHz */
119 else if (freq < 802000000) reg05 = 0x54; /* 802 MHz */
120 else reg05 = 0x74;
121
122 /* 0x5 */
123 rd[2].val = reg05;
124
125 /* 07 - set frequency: 32 MHz scale */
126 rd[4].val = (freq + QT1010_OFFSET) / FREQ1;
127
128 /* 09 - changes every 8/24 MHz */
129 if (mod1 < 8000000) rd[6].val = 0x1d;
130 else rd[6].val = 0x1c;
131
132 /* 0a - set frequency: 4 MHz scale (max 28 MHz) */
133 if (mod1 < 1*FREQ2) rd[7].val = 0x09; /* +0 MHz */
134 else if (mod1 < 2*FREQ2) rd[7].val = 0x08; /* +4 MHz */
135 else if (mod1 < 3*FREQ2) rd[7].val = 0x0f; /* +8 MHz */
136 else if (mod1 < 4*FREQ2) rd[7].val = 0x0e; /* +12 MHz */
137 else if (mod1 < 5*FREQ2) rd[7].val = 0x0d; /* +16 MHz */
138 else if (mod1 < 6*FREQ2) rd[7].val = 0x0c; /* +20 MHz */
139 else if (mod1 < 7*FREQ2) rd[7].val = 0x0b; /* +24 MHz */
140 else rd[7].val = 0x0a; /* +28 MHz */
141
142 /* 0b - changes every 2/2 MHz */
143 if (mod2 < 2000000) rd[8].val = 0x45;
144 else rd[8].val = 0x44;
145
146 /* 1a - set frequency: 125 kHz scale (max 3875 kHz)*/
147 tmpval = 0x78; /* byte, overflows intentionally */
148 rd[10].val = tmpval-((mod2/QT1010_STEP)*0x08);
149
150 /* 11 */
151 rd[13].val = 0xfd; /* TODO: correct value calculation */
152
153 /* 12 */
154 rd[14].val = 0x91; /* TODO: correct value calculation */
155
156 /* 22 */
157 if (freq < 450000000) rd[15].val = 0xd0; /* 450 MHz */
158 else if (freq < 482000000) rd[15].val = 0xd1; /* 482 MHz */
159 else if (freq < 514000000) rd[15].val = 0xd4; /* 514 MHz */
160 else if (freq < 546000000) rd[15].val = 0xd7; /* 546 MHz */
161 else if (freq < 610000000) rd[15].val = 0xda; /* 610 MHz */
162 else rd[15].val = 0xd0;
163
164 /* 05 */
165 rd[35].val = (reg05 & 0xf0);
166
167 /* 1f */
168 if (mod1 < 8000000) tmpval = 0x00;
169 else if (mod1 < 12000000) tmpval = 0x01;
170 else if (mod1 < 16000000) tmpval = 0x02;
171 else if (mod1 < 24000000) tmpval = 0x03;
172 else if (mod1 < 28000000) tmpval = 0x04;
173 else tmpval = 0x05;
174 rd[40].val = (priv->reg1f_init_val + 0x0e + tmpval);
175
176 /* 20 */
177 if (mod1 < 8000000) tmpval = 0x00;
178 else if (mod1 < 12000000) tmpval = 0x01;
179 else if (mod1 < 20000000) tmpval = 0x02;
180 else if (mod1 < 24000000) tmpval = 0x03;
181 else if (mod1 < 28000000) tmpval = 0x04;
182 else tmpval = 0x05;
183 rd[41].val = (priv->reg20_init_val + 0x0d + tmpval);
184
185 /* 25 */
186 rd[43].val = priv->reg25_init_val;
187
188 /* 00 */
189 rd[45].val = 0x92; /* TODO: correct value calculation */
190
191 dev_dbg(&priv->i2c->dev,
192 "%s: freq:%u 05:%02x 07:%02x 09:%02x 0a:%02x 0b:%02x " \
193 "1a:%02x 11:%02x 12:%02x 22:%02x 05:%02x 1f:%02x " \
194 "20:%02x 25:%02x 00:%02x\n", __func__, \
195 freq, rd[2].val, rd[4].val, rd[6].val, rd[7].val, \
196 rd[8].val, rd[10].val, rd[13].val, rd[14].val, \
197 rd[15].val, rd[35].val, rd[40].val, rd[41].val, \
198 rd[43].val, rd[45].val);
199
200 for (i = 0; i < ARRAY_SIZE(rd); i++) {
201 if (rd[i].oper == QT1010_WR) {
202 err = qt1010_writereg(priv, rd[i].reg, rd[i].val);
203 } else { /* read is required to proper locking */
204 err = qt1010_readreg(priv, rd[i].reg, &tmpval);
205 }
206 if (err) return err;
207 }
208
209 if (fe->ops.i2c_gate_ctrl)
210 fe->ops.i2c_gate_ctrl(fe, 0); /* close i2c_gate */
211
212 return 0;
213 }
214
215 static int qt1010_init_meas1(struct qt1010_priv *priv,
216 u8 oper, u8 reg, u8 reg_init_val, u8 *retval)
217 {
218 u8 i, val1, val2;
219 int err;
220
221 qt1010_i2c_oper_t i2c_data[] = {
222 { QT1010_WR, reg, reg_init_val },
223 { QT1010_WR, 0x1e, 0x00 },
224 { QT1010_WR, 0x1e, oper },
225 };
226
227 for (i = 0; i < ARRAY_SIZE(i2c_data); i++) {
228 err = qt1010_writereg(priv, i2c_data[i].reg,
229 i2c_data[i].val);
230 if (err)
231 return err;
232 }
233
234 err = qt1010_readreg(priv, reg, &val2);
235 if (err)
236 return err;
237 do {
238 val1 = val2;
239 err = qt1010_readreg(priv, reg, &val2);
240 if (err)
241 return err;
242
243 dev_dbg(&priv->i2c->dev, "%s: compare reg:%02x %02x %02x\n",
244 __func__, reg, val1, val2);
245 } while (val1 != val2);
246 *retval = val1;
247
248 return qt1010_writereg(priv, 0x1e, 0x00);
249 }
250
251 static int qt1010_init_meas2(struct qt1010_priv *priv,
252 u8 reg_init_val, u8 *retval)
253 {
254 u8 i, val = 0xff;
255 int err;
256 qt1010_i2c_oper_t i2c_data[] = {
257 { QT1010_WR, 0x07, reg_init_val },
258 { QT1010_WR, 0x22, 0xd0 },
259 { QT1010_WR, 0x1e, 0x00 },
260 { QT1010_WR, 0x1e, 0xd0 },
261 { QT1010_RD, 0x22, 0xff },
262 { QT1010_WR, 0x1e, 0x00 },
263 { QT1010_WR, 0x22, 0xff }
264 };
265
266 for (i = 0; i < ARRAY_SIZE(i2c_data); i++) {
267 if (i2c_data[i].oper == QT1010_WR) {
268 err = qt1010_writereg(priv, i2c_data[i].reg,
269 i2c_data[i].val);
270 } else {
271 err = qt1010_readreg(priv, i2c_data[i].reg, &val);
272 }
273 if (err)
274 return err;
275 }
276 *retval = val;
277 return 0;
278 }
279
280 static int qt1010_init(struct dvb_frontend *fe)
281 {
282 struct qt1010_priv *priv = fe->tuner_priv;
283 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
284 int err = 0;
285 u8 i, tmpval, *valptr = NULL;
286
287 static const qt1010_i2c_oper_t i2c_data[] = {
288 { QT1010_WR, 0x01, 0x80 },
289 { QT1010_WR, 0x0d, 0x84 },
290 { QT1010_WR, 0x0e, 0xb7 },
291 { QT1010_WR, 0x2a, 0x23 },
292 { QT1010_WR, 0x2c, 0xdc },
293 { QT1010_M1, 0x25, 0x40 }, /* get reg 25 init value */
294 { QT1010_M1, 0x81, 0xff }, /* get reg 25 init value */
295 { QT1010_WR, 0x2b, 0x70 },
296 { QT1010_WR, 0x2a, 0x23 },
297 { QT1010_M1, 0x26, 0x08 },
298 { QT1010_M1, 0x82, 0xff },
299 { QT1010_WR, 0x05, 0x14 },
300 { QT1010_WR, 0x06, 0x44 },
301 { QT1010_WR, 0x07, 0x28 },
302 { QT1010_WR, 0x08, 0x0b },
303 { QT1010_WR, 0x11, 0xfd },
304 { QT1010_M1, 0x22, 0x0d },
305 { QT1010_M1, 0xd0, 0xff },
306 { QT1010_WR, 0x06, 0x40 },
307 { QT1010_WR, 0x16, 0xf0 },
308 { QT1010_WR, 0x02, 0x38 },
309 { QT1010_WR, 0x03, 0x18 },
310 { QT1010_WR, 0x20, 0xe0 },
311 { QT1010_M1, 0x1f, 0x20 }, /* get reg 1f init value */
312 { QT1010_M1, 0x84, 0xff }, /* get reg 1f init value */
313 { QT1010_RD, 0x20, 0x20 }, /* get reg 20 init value */
314 { QT1010_WR, 0x03, 0x19 },
315 { QT1010_WR, 0x02, 0x3f },
316 { QT1010_WR, 0x21, 0x53 },
317 { QT1010_RD, 0x21, 0xff },
318 { QT1010_WR, 0x11, 0xfd },
319 { QT1010_WR, 0x05, 0x34 },
320 { QT1010_WR, 0x06, 0x44 },
321 { QT1010_WR, 0x08, 0x08 }
322 };
323
324 if (fe->ops.i2c_gate_ctrl)
325 fe->ops.i2c_gate_ctrl(fe, 1); /* open i2c_gate */
326
327 for (i = 0; i < ARRAY_SIZE(i2c_data); i++) {
328 switch (i2c_data[i].oper) {
329 case QT1010_WR:
330 err = qt1010_writereg(priv, i2c_data[i].reg,
331 i2c_data[i].val);
332 break;
333 case QT1010_RD:
334 if (i2c_data[i].val == 0x20)
335 valptr = &priv->reg20_init_val;
336 else
337 valptr = &tmpval;
338 err = qt1010_readreg(priv, i2c_data[i].reg, valptr);
339 break;
340 case QT1010_M1:
341 if (i2c_data[i].val == 0x25)
342 valptr = &priv->reg25_init_val;
343 else if (i2c_data[i].val == 0x1f)
344 valptr = &priv->reg1f_init_val;
345 else
346 valptr = &tmpval;
347
348 if (i >= ARRAY_SIZE(i2c_data) - 1)
349 err = -EIO;
350 else
351 err = qt1010_init_meas1(priv, i2c_data[i + 1].reg,
352 i2c_data[i].reg,
353 i2c_data[i].val, valptr);
354 i++;
355 break;
356 }
357 if (err)
358 return err;
359 }
360
361 for (i = 0x31; i < 0x3a; i++) /* 0x31 - 0x39 */
362 if ((err = qt1010_init_meas2(priv, i, &tmpval)))
363 return err;
364
365 if (!c->frequency)
366 c->frequency = 545000000; /* Sigmatek DVB-110 545000000 */
367 /* MSI Megasky 580 GL861 533000000 */
368 return qt1010_set_params(fe);
369 }
370
371 static void qt1010_release(struct dvb_frontend *fe)
372 {
373 kfree(fe->tuner_priv);
374 fe->tuner_priv = NULL;
375 }
376
377 static int qt1010_get_frequency(struct dvb_frontend *fe, u32 *frequency)
378 {
379 struct qt1010_priv *priv = fe->tuner_priv;
380 *frequency = priv->frequency;
381 return 0;
382 }
383
384 static int qt1010_get_if_frequency(struct dvb_frontend *fe, u32 *frequency)
385 {
386 *frequency = 36125000;
387 return 0;
388 }
389
390 static const struct dvb_tuner_ops qt1010_tuner_ops = {
391 .info = {
392 .name = "Quantek QT1010",
393 .frequency_min_hz = QT1010_MIN_FREQ,
394 .frequency_max_hz = QT1010_MAX_FREQ,
395 .frequency_step_hz = QT1010_STEP,
396 },
397
398 .release = qt1010_release,
399 .init = qt1010_init,
400 /* TODO: implement sleep */
401
402 .set_params = qt1010_set_params,
403 .get_frequency = qt1010_get_frequency,
404 .get_if_frequency = qt1010_get_if_frequency,
405 };
406
407 struct dvb_frontend * qt1010_attach(struct dvb_frontend *fe,
408 struct i2c_adapter *i2c,
409 struct qt1010_config *cfg)
410 {
411 struct qt1010_priv *priv = NULL;
412 u8 id;
413
414 priv = kzalloc(sizeof(struct qt1010_priv), GFP_KERNEL);
415 if (priv == NULL)
416 return NULL;
417
418 priv->cfg = cfg;
419 priv->i2c = i2c;
420
421 if (fe->ops.i2c_gate_ctrl)
422 fe->ops.i2c_gate_ctrl(fe, 1); /* open i2c_gate */
423
424
425 /* Try to detect tuner chip. Probably this is not correct register. */
426 if (qt1010_readreg(priv, 0x29, &id) != 0 || (id != 0x39)) {
427 kfree(priv);
428 return NULL;
429 }
430
431 if (fe->ops.i2c_gate_ctrl)
432 fe->ops.i2c_gate_ctrl(fe, 0); /* close i2c_gate */
433
434 dev_info(&priv->i2c->dev,
435 "%s: Quantek QT1010 successfully identified\n",
436 KBUILD_MODNAME);
437
438 memcpy(&fe->ops.tuner_ops, &qt1010_tuner_ops,
439 sizeof(struct dvb_tuner_ops));
440
441 fe->tuner_priv = priv;
442 return fe;
443 }
444 EXPORT_SYMBOL_GPL(qt1010_attach);
445
446 MODULE_DESCRIPTION("Quantek QT1010 silicon tuner driver");
447 MODULE_AUTHOR("Antti Palosaari <crope@iki.fi>");
448 MODULE_AUTHOR("Aapo Tahkola <aet@rasterburn.org>");
449 MODULE_VERSION("0.1");
450 MODULE_LICENSE("GPL");
Kernel DRM miscellaneous fixes and cross-tree changes