1 | // SPDX-License-Identifier: GPL-2.0-or-later |
2 | /* |
3 | * Support for Legend Silicon GB20600 (a.k.a DMB-TH) demodulator |
4 | * LGS8913, LGS8GL5, LGS8G75 |
5 | * experimental support LGS8G42, LGS8G52 |
6 | * |
7 | * Copyright (C) 2007-2009 David T.L. Wong <davidtlwong@gmail.com> |
8 | * Copyright (C) 2008 Sirius International (Hong Kong) Limited |
9 | * Timothy Lee <timothy.lee@siriushk.com> (for initial work on LGS8GL5) |
10 | */ |
11 | |
12 | #include <asm/div64.h> |
13 | #include <linux/firmware.h> |
14 | |
15 | #include <media/dvb_frontend.h> |
16 | |
17 | #include "lgs8gxx.h" |
18 | #include "lgs8gxx_priv.h" |
19 | |
20 | #define dprintk(args...) \ |
21 | do { \ |
22 | if (debug) \ |
23 | printk(KERN_DEBUG "lgs8gxx: " args); \ |
24 | } while (0) |
25 | |
26 | static int debug; |
27 | static int fake_signal_str = 1; |
28 | |
29 | #define LGS8GXX_FIRMWARE "lgs8g75.fw" |
30 | |
31 | module_param(debug, int, 0644); |
32 | MODULE_PARM_DESC(debug, "Turn on/off frontend debugging (default:off)." ); |
33 | |
34 | module_param(fake_signal_str, int, 0644); |
35 | MODULE_PARM_DESC(fake_signal_str, "fake signal strength for LGS8913." |
36 | "Signal strength calculation is slow.(default:on)." ); |
37 | |
38 | /* LGS8GXX internal helper functions */ |
39 | |
40 | static int lgs8gxx_write_reg(struct lgs8gxx_state *priv, u8 reg, u8 data) |
41 | { |
42 | int ret; |
43 | u8 buf[] = { reg, data }; |
44 | struct i2c_msg msg = { .flags = 0, .buf = buf, .len = 2 }; |
45 | |
46 | msg.addr = priv->config->demod_address; |
47 | if (priv->config->prod != LGS8GXX_PROD_LGS8G75 && reg >= 0xC0) |
48 | msg.addr += 0x02; |
49 | |
50 | if (debug >= 2) |
51 | dprintk("%s: reg=0x%02X, data=0x%02X\n" , __func__, reg, data); |
52 | |
53 | ret = i2c_transfer(adap: priv->i2c, msgs: &msg, num: 1); |
54 | |
55 | if (ret != 1) |
56 | dprintk("%s: error reg=0x%x, data=0x%x, ret=%i\n" , |
57 | __func__, reg, data, ret); |
58 | |
59 | return (ret != 1) ? -1 : 0; |
60 | } |
61 | |
62 | static int lgs8gxx_read_reg(struct lgs8gxx_state *priv, u8 reg, u8 *p_data) |
63 | { |
64 | int ret; |
65 | u8 dev_addr; |
66 | |
67 | u8 b0[] = { reg }; |
68 | u8 b1[] = { 0 }; |
69 | struct i2c_msg msg[] = { |
70 | { .flags = 0, .buf = b0, .len = 1 }, |
71 | { .flags = I2C_M_RD, .buf = b1, .len = 1 }, |
72 | }; |
73 | |
74 | dev_addr = priv->config->demod_address; |
75 | if (priv->config->prod != LGS8GXX_PROD_LGS8G75 && reg >= 0xC0) |
76 | dev_addr += 0x02; |
77 | msg[1].addr = msg[0].addr = dev_addr; |
78 | |
79 | ret = i2c_transfer(adap: priv->i2c, msgs: msg, num: 2); |
80 | if (ret != 2) { |
81 | dprintk("%s: error reg=0x%x, ret=%i\n" , __func__, reg, ret); |
82 | return -1; |
83 | } |
84 | |
85 | *p_data = b1[0]; |
86 | if (debug >= 2) |
87 | dprintk("%s: reg=0x%02X, data=0x%02X\n" , __func__, reg, b1[0]); |
88 | return 0; |
89 | } |
90 | |
91 | static int lgs8gxx_soft_reset(struct lgs8gxx_state *priv) |
92 | { |
93 | lgs8gxx_write_reg(priv, reg: 0x02, data: 0x00); |
94 | msleep(msecs: 1); |
95 | lgs8gxx_write_reg(priv, reg: 0x02, data: 0x01); |
96 | msleep(msecs: 100); |
97 | |
98 | return 0; |
99 | } |
100 | |
101 | static int wait_reg_mask(struct lgs8gxx_state *priv, u8 reg, u8 mask, |
102 | u8 val, u8 delay, u8 tries) |
103 | { |
104 | u8 t; |
105 | int i; |
106 | |
107 | for (i = 0; i < tries; i++) { |
108 | lgs8gxx_read_reg(priv, reg, p_data: &t); |
109 | |
110 | if ((t & mask) == val) |
111 | return 0; |
112 | msleep(msecs: delay); |
113 | } |
114 | |
115 | return 1; |
116 | } |
117 | |
118 | static int lgs8gxx_set_ad_mode(struct lgs8gxx_state *priv) |
119 | { |
120 | const struct lgs8gxx_config *config = priv->config; |
121 | u8 if_conf; |
122 | |
123 | if_conf = 0x10; /* AGC output on, RF_AGC output off; */ |
124 | |
125 | if_conf |= |
126 | ((config->ext_adc) ? 0x80 : 0x00) | |
127 | ((config->if_neg_center) ? 0x04 : 0x00) | |
128 | ((config->if_freq == 0) ? 0x08 : 0x00) | /* Baseband */ |
129 | ((config->adc_signed) ? 0x02 : 0x00) | |
130 | ((config->if_neg_edge) ? 0x01 : 0x00); |
131 | |
132 | if (config->ext_adc && |
133 | (config->prod == LGS8GXX_PROD_LGS8G52)) { |
134 | lgs8gxx_write_reg(priv, reg: 0xBA, data: 0x40); |
135 | } |
136 | |
137 | lgs8gxx_write_reg(priv, reg: 0x07, data: if_conf); |
138 | |
139 | return 0; |
140 | } |
141 | |
142 | static int lgs8gxx_set_if_freq(struct lgs8gxx_state *priv, u32 freq /*in kHz*/) |
143 | { |
144 | u64 val; |
145 | u32 v32; |
146 | u32 if_clk; |
147 | |
148 | if_clk = priv->config->if_clk_freq; |
149 | |
150 | val = freq; |
151 | if (freq != 0) { |
152 | val <<= 32; |
153 | if (if_clk != 0) |
154 | do_div(val, if_clk); |
155 | v32 = val & 0xFFFFFFFF; |
156 | dprintk("Set IF Freq to %dkHz\n" , freq); |
157 | } else { |
158 | v32 = 0; |
159 | dprintk("Set IF Freq to baseband\n" ); |
160 | } |
161 | dprintk("AFC_INIT_FREQ = 0x%08X\n" , v32); |
162 | |
163 | if (priv->config->prod == LGS8GXX_PROD_LGS8G75) { |
164 | lgs8gxx_write_reg(priv, reg: 0x08, data: 0xFF & (v32)); |
165 | lgs8gxx_write_reg(priv, reg: 0x09, data: 0xFF & (v32 >> 8)); |
166 | lgs8gxx_write_reg(priv, reg: 0x0A, data: 0xFF & (v32 >> 16)); |
167 | lgs8gxx_write_reg(priv, reg: 0x0B, data: 0xFF & (v32 >> 24)); |
168 | } else { |
169 | lgs8gxx_write_reg(priv, reg: 0x09, data: 0xFF & (v32)); |
170 | lgs8gxx_write_reg(priv, reg: 0x0A, data: 0xFF & (v32 >> 8)); |
171 | lgs8gxx_write_reg(priv, reg: 0x0B, data: 0xFF & (v32 >> 16)); |
172 | lgs8gxx_write_reg(priv, reg: 0x0C, data: 0xFF & (v32 >> 24)); |
173 | } |
174 | |
175 | return 0; |
176 | } |
177 | |
178 | static int lgs8gxx_get_afc_phase(struct lgs8gxx_state *priv) |
179 | { |
180 | u64 val; |
181 | u32 v32 = 0; |
182 | u8 reg_addr, t; |
183 | int i; |
184 | |
185 | if (priv->config->prod == LGS8GXX_PROD_LGS8G75) |
186 | reg_addr = 0x23; |
187 | else |
188 | reg_addr = 0x48; |
189 | |
190 | for (i = 0; i < 4; i++) { |
191 | lgs8gxx_read_reg(priv, reg: reg_addr, p_data: &t); |
192 | v32 <<= 8; |
193 | v32 |= t; |
194 | reg_addr--; |
195 | } |
196 | |
197 | val = v32; |
198 | val *= priv->config->if_clk_freq; |
199 | val >>= 32; |
200 | dprintk("AFC = %u kHz\n" , (u32)val); |
201 | return 0; |
202 | } |
203 | |
204 | static int lgs8gxx_set_mode_auto(struct lgs8gxx_state *priv) |
205 | { |
206 | u8 t; |
207 | u8 prod = priv->config->prod; |
208 | |
209 | if (prod == LGS8GXX_PROD_LGS8913) |
210 | lgs8gxx_write_reg(priv, reg: 0xC6, data: 0x01); |
211 | |
212 | if (prod == LGS8GXX_PROD_LGS8G75) { |
213 | lgs8gxx_read_reg(priv, reg: 0x0C, p_data: &t); |
214 | t &= (~0x04); |
215 | lgs8gxx_write_reg(priv, reg: 0x0C, data: t | 0x80); |
216 | lgs8gxx_write_reg(priv, reg: 0x39, data: 0x00); |
217 | lgs8gxx_write_reg(priv, reg: 0x3D, data: 0x04); |
218 | } else if (prod == LGS8GXX_PROD_LGS8913 || |
219 | prod == LGS8GXX_PROD_LGS8GL5 || |
220 | prod == LGS8GXX_PROD_LGS8G42 || |
221 | prod == LGS8GXX_PROD_LGS8G52 || |
222 | prod == LGS8GXX_PROD_LGS8G54) { |
223 | lgs8gxx_read_reg(priv, reg: 0x7E, p_data: &t); |
224 | lgs8gxx_write_reg(priv, reg: 0x7E, data: t | 0x01); |
225 | |
226 | /* clear FEC self reset */ |
227 | lgs8gxx_read_reg(priv, reg: 0xC5, p_data: &t); |
228 | lgs8gxx_write_reg(priv, reg: 0xC5, data: t & 0xE0); |
229 | } |
230 | |
231 | if (prod == LGS8GXX_PROD_LGS8913) { |
232 | /* FEC auto detect */ |
233 | lgs8gxx_write_reg(priv, reg: 0xC1, data: 0x03); |
234 | |
235 | lgs8gxx_read_reg(priv, reg: 0x7C, p_data: &t); |
236 | t = (t & 0x8C) | 0x03; |
237 | lgs8gxx_write_reg(priv, reg: 0x7C, data: t); |
238 | |
239 | /* BER test mode */ |
240 | lgs8gxx_read_reg(priv, reg: 0xC3, p_data: &t); |
241 | t = (t & 0xEF) | 0x10; |
242 | lgs8gxx_write_reg(priv, reg: 0xC3, data: t); |
243 | } |
244 | |
245 | if (priv->config->prod == LGS8GXX_PROD_LGS8G52) |
246 | lgs8gxx_write_reg(priv, reg: 0xD9, data: 0x40); |
247 | |
248 | return 0; |
249 | } |
250 | |
251 | static int lgs8gxx_set_mode_manual(struct lgs8gxx_state *priv) |
252 | { |
253 | u8 t; |
254 | |
255 | if (priv->config->prod == LGS8GXX_PROD_LGS8G75) { |
256 | u8 t2; |
257 | lgs8gxx_read_reg(priv, reg: 0x0C, p_data: &t); |
258 | t &= (~0x80); |
259 | lgs8gxx_write_reg(priv, reg: 0x0C, data: t); |
260 | |
261 | lgs8gxx_read_reg(priv, reg: 0x0C, p_data: &t); |
262 | lgs8gxx_read_reg(priv, reg: 0x19, p_data: &t2); |
263 | |
264 | if (((t&0x03) == 0x01) && (t2&0x01)) { |
265 | lgs8gxx_write_reg(priv, reg: 0x6E, data: 0x05); |
266 | lgs8gxx_write_reg(priv, reg: 0x39, data: 0x02); |
267 | lgs8gxx_write_reg(priv, reg: 0x39, data: 0x03); |
268 | lgs8gxx_write_reg(priv, reg: 0x3D, data: 0x05); |
269 | lgs8gxx_write_reg(priv, reg: 0x3E, data: 0x28); |
270 | lgs8gxx_write_reg(priv, reg: 0x53, data: 0x80); |
271 | } else { |
272 | lgs8gxx_write_reg(priv, reg: 0x6E, data: 0x3F); |
273 | lgs8gxx_write_reg(priv, reg: 0x39, data: 0x00); |
274 | lgs8gxx_write_reg(priv, reg: 0x3D, data: 0x04); |
275 | } |
276 | |
277 | lgs8gxx_soft_reset(priv); |
278 | return 0; |
279 | } |
280 | |
281 | /* turn off auto-detect; manual settings */ |
282 | lgs8gxx_write_reg(priv, reg: 0x7E, data: 0); |
283 | if (priv->config->prod == LGS8GXX_PROD_LGS8913) |
284 | lgs8gxx_write_reg(priv, reg: 0xC1, data: 0); |
285 | |
286 | lgs8gxx_read_reg(priv, reg: 0xC5, p_data: &t); |
287 | t = (t & 0xE0) | 0x06; |
288 | lgs8gxx_write_reg(priv, reg: 0xC5, data: t); |
289 | |
290 | lgs8gxx_soft_reset(priv); |
291 | |
292 | return 0; |
293 | } |
294 | |
295 | static int lgs8gxx_is_locked(struct lgs8gxx_state *priv, u8 *locked) |
296 | { |
297 | int ret = 0; |
298 | u8 t; |
299 | |
300 | if (priv->config->prod == LGS8GXX_PROD_LGS8G75) |
301 | ret = lgs8gxx_read_reg(priv, reg: 0x13, p_data: &t); |
302 | else |
303 | ret = lgs8gxx_read_reg(priv, reg: 0x4B, p_data: &t); |
304 | if (ret != 0) |
305 | return ret; |
306 | |
307 | if (priv->config->prod == LGS8GXX_PROD_LGS8G75) |
308 | *locked = ((t & 0x80) == 0x80) ? 1 : 0; |
309 | else |
310 | *locked = ((t & 0xC0) == 0xC0) ? 1 : 0; |
311 | return 0; |
312 | } |
313 | |
314 | /* Wait for Code Acquisition Lock */ |
315 | static int lgs8gxx_wait_ca_lock(struct lgs8gxx_state *priv, u8 *locked) |
316 | { |
317 | int ret = 0; |
318 | u8 reg, mask, val; |
319 | |
320 | if (priv->config->prod == LGS8GXX_PROD_LGS8G75) { |
321 | reg = 0x13; |
322 | mask = 0x80; |
323 | val = 0x80; |
324 | } else { |
325 | reg = 0x4B; |
326 | mask = 0xC0; |
327 | val = 0xC0; |
328 | } |
329 | |
330 | ret = wait_reg_mask(priv, reg, mask, val, delay: 50, tries: 40); |
331 | *locked = (ret == 0) ? 1 : 0; |
332 | |
333 | return 0; |
334 | } |
335 | |
336 | static int lgs8gxx_is_autodetect_finished(struct lgs8gxx_state *priv, |
337 | u8 *finished) |
338 | { |
339 | int ret = 0; |
340 | u8 reg, mask, val; |
341 | |
342 | if (priv->config->prod == LGS8GXX_PROD_LGS8G75) { |
343 | reg = 0x1f; |
344 | mask = 0xC0; |
345 | val = 0x80; |
346 | } else { |
347 | reg = 0xA4; |
348 | mask = 0x03; |
349 | val = 0x01; |
350 | } |
351 | |
352 | ret = wait_reg_mask(priv, reg, mask, val, delay: 10, tries: 20); |
353 | *finished = (ret == 0) ? 1 : 0; |
354 | |
355 | return 0; |
356 | } |
357 | |
358 | static int lgs8gxx_autolock_gi(struct lgs8gxx_state *priv, u8 gi, u8 cpn, |
359 | u8 *locked) |
360 | { |
361 | int err = 0; |
362 | u8 ad_fini = 0; |
363 | u8 t1, t2; |
364 | |
365 | if (gi == GI_945) |
366 | dprintk("try GI 945\n" ); |
367 | else if (gi == GI_595) |
368 | dprintk("try GI 595\n" ); |
369 | else if (gi == GI_420) |
370 | dprintk("try GI 420\n" ); |
371 | if (priv->config->prod == LGS8GXX_PROD_LGS8G75) { |
372 | lgs8gxx_read_reg(priv, reg: 0x0C, p_data: &t1); |
373 | lgs8gxx_read_reg(priv, reg: 0x18, p_data: &t2); |
374 | t1 &= ~(GI_MASK); |
375 | t1 |= gi; |
376 | t2 &= 0xFE; |
377 | t2 |= cpn ? 0x01 : 0x00; |
378 | lgs8gxx_write_reg(priv, reg: 0x0C, data: t1); |
379 | lgs8gxx_write_reg(priv, reg: 0x18, data: t2); |
380 | } else { |
381 | lgs8gxx_write_reg(priv, reg: 0x04, data: gi); |
382 | } |
383 | lgs8gxx_soft_reset(priv); |
384 | err = lgs8gxx_wait_ca_lock(priv, locked); |
385 | if (err || !(*locked)) |
386 | return err; |
387 | err = lgs8gxx_is_autodetect_finished(priv, finished: &ad_fini); |
388 | if (err != 0) |
389 | return err; |
390 | if (ad_fini) { |
391 | dprintk("auto detect finished\n" ); |
392 | } else |
393 | *locked = 0; |
394 | |
395 | return 0; |
396 | } |
397 | |
398 | static int lgs8gxx_auto_detect(struct lgs8gxx_state *priv, |
399 | u8 *detected_param, u8 *gi) |
400 | { |
401 | int i, j; |
402 | int err = 0; |
403 | u8 locked = 0, tmp_gi; |
404 | |
405 | dprintk("%s\n" , __func__); |
406 | |
407 | lgs8gxx_set_mode_auto(priv); |
408 | if (priv->config->prod == LGS8GXX_PROD_LGS8G75) { |
409 | lgs8gxx_write_reg(priv, reg: 0x67, data: 0xAA); |
410 | lgs8gxx_write_reg(priv, reg: 0x6E, data: 0x3F); |
411 | } else { |
412 | /* Guard Interval */ |
413 | lgs8gxx_write_reg(priv, reg: 0x03, data: 00); |
414 | } |
415 | |
416 | for (i = 0; i < 2; i++) { |
417 | for (j = 0; j < 2; j++) { |
418 | tmp_gi = GI_945; |
419 | err = lgs8gxx_autolock_gi(priv, GI_945, cpn: j, locked: &locked); |
420 | if (err) |
421 | goto out; |
422 | if (locked) |
423 | goto locked; |
424 | } |
425 | for (j = 0; j < 2; j++) { |
426 | tmp_gi = GI_420; |
427 | err = lgs8gxx_autolock_gi(priv, GI_420, cpn: j, locked: &locked); |
428 | if (err) |
429 | goto out; |
430 | if (locked) |
431 | goto locked; |
432 | } |
433 | tmp_gi = GI_595; |
434 | err = lgs8gxx_autolock_gi(priv, GI_595, cpn: 1, locked: &locked); |
435 | if (err) |
436 | goto out; |
437 | if (locked) |
438 | goto locked; |
439 | } |
440 | |
441 | locked: |
442 | if ((err == 0) && (locked == 1)) { |
443 | u8 t; |
444 | |
445 | if (priv->config->prod != LGS8GXX_PROD_LGS8G75) { |
446 | lgs8gxx_read_reg(priv, reg: 0xA2, p_data: &t); |
447 | *detected_param = t; |
448 | } else { |
449 | lgs8gxx_read_reg(priv, reg: 0x1F, p_data: &t); |
450 | *detected_param = t & 0x3F; |
451 | } |
452 | |
453 | if (tmp_gi == GI_945) |
454 | dprintk("GI 945 locked\n" ); |
455 | else if (tmp_gi == GI_595) |
456 | dprintk("GI 595 locked\n" ); |
457 | else if (tmp_gi == GI_420) |
458 | dprintk("GI 420 locked\n" ); |
459 | *gi = tmp_gi; |
460 | } |
461 | if (!locked) |
462 | err = -1; |
463 | |
464 | out: |
465 | return err; |
466 | } |
467 | |
468 | static void lgs8gxx_auto_lock(struct lgs8gxx_state *priv) |
469 | { |
470 | s8 err; |
471 | u8 gi = 0x2; |
472 | u8 detected_param = 0; |
473 | |
474 | err = lgs8gxx_auto_detect(priv, detected_param: &detected_param, gi: &gi); |
475 | |
476 | if (err != 0) { |
477 | dprintk("lgs8gxx_auto_detect failed\n" ); |
478 | } else |
479 | dprintk("detected param = 0x%02X\n" , detected_param); |
480 | |
481 | /* Apply detected parameters */ |
482 | if (priv->config->prod == LGS8GXX_PROD_LGS8913) { |
483 | u8 inter_leave_len = detected_param & TIM_MASK ; |
484 | /* Fix 8913 time interleaver detection bug */ |
485 | inter_leave_len = (inter_leave_len == TIM_MIDDLE) ? 0x60 : 0x40; |
486 | detected_param &= CF_MASK | SC_MASK | LGS_FEC_MASK; |
487 | detected_param |= inter_leave_len; |
488 | } |
489 | if (priv->config->prod == LGS8GXX_PROD_LGS8G75) { |
490 | u8 t; |
491 | lgs8gxx_read_reg(priv, reg: 0x19, p_data: &t); |
492 | t &= 0x81; |
493 | t |= detected_param << 1; |
494 | lgs8gxx_write_reg(priv, reg: 0x19, data: t); |
495 | } else { |
496 | lgs8gxx_write_reg(priv, reg: 0x7D, data: detected_param); |
497 | if (priv->config->prod == LGS8GXX_PROD_LGS8913) |
498 | lgs8gxx_write_reg(priv, reg: 0xC0, data: detected_param); |
499 | } |
500 | /* lgs8gxx_soft_reset(priv); */ |
501 | |
502 | /* Enter manual mode */ |
503 | lgs8gxx_set_mode_manual(priv); |
504 | |
505 | switch (gi) { |
506 | case GI_945: |
507 | priv->curr_gi = 945; break; |
508 | case GI_595: |
509 | priv->curr_gi = 595; break; |
510 | case GI_420: |
511 | priv->curr_gi = 420; break; |
512 | default: |
513 | priv->curr_gi = 945; break; |
514 | } |
515 | } |
516 | |
517 | static int lgs8gxx_set_mpeg_mode(struct lgs8gxx_state *priv, |
518 | u8 serial, u8 clk_pol, u8 clk_gated) |
519 | { |
520 | int ret = 0; |
521 | u8 t, reg_addr; |
522 | |
523 | reg_addr = (priv->config->prod == LGS8GXX_PROD_LGS8G75) ? 0x30 : 0xC2; |
524 | ret = lgs8gxx_read_reg(priv, reg: reg_addr, p_data: &t); |
525 | if (ret != 0) |
526 | return ret; |
527 | |
528 | t &= 0xF8; |
529 | t |= serial ? TS_SERIAL : TS_PARALLEL; |
530 | t |= clk_pol ? TS_CLK_INVERTED : TS_CLK_NORMAL; |
531 | t |= clk_gated ? TS_CLK_GATED : TS_CLK_FREERUN; |
532 | |
533 | ret = lgs8gxx_write_reg(priv, reg: reg_addr, data: t); |
534 | if (ret != 0) |
535 | return ret; |
536 | |
537 | return 0; |
538 | } |
539 | |
540 | /* A/D input peak-to-peak voltage range */ |
541 | static int lgs8g75_set_adc_vpp(struct lgs8gxx_state *priv, |
542 | u8 sel) |
543 | { |
544 | u8 r26 = 0x73, r27 = 0x90; |
545 | |
546 | if (priv->config->prod != LGS8GXX_PROD_LGS8G75) |
547 | return 0; |
548 | |
549 | r26 |= (sel & 0x01) << 7; |
550 | r27 |= (sel & 0x02) >> 1; |
551 | lgs8gxx_write_reg(priv, reg: 0x26, data: r26); |
552 | lgs8gxx_write_reg(priv, reg: 0x27, data: r27); |
553 | |
554 | return 0; |
555 | } |
556 | |
557 | /* LGS8913 demod frontend functions */ |
558 | |
559 | static int lgs8913_init(struct lgs8gxx_state *priv) |
560 | { |
561 | u8 t; |
562 | |
563 | /* LGS8913 specific */ |
564 | lgs8gxx_write_reg(priv, reg: 0xc1, data: 0x3); |
565 | |
566 | lgs8gxx_read_reg(priv, reg: 0x7c, p_data: &t); |
567 | lgs8gxx_write_reg(priv, reg: 0x7c, data: (t&0x8c) | 0x3); |
568 | |
569 | /* LGS8913 specific */ |
570 | lgs8gxx_read_reg(priv, reg: 0xc3, p_data: &t); |
571 | lgs8gxx_write_reg(priv, reg: 0xc3, data: t&0x10); |
572 | |
573 | |
574 | return 0; |
575 | } |
576 | |
577 | static int lgs8g75_init_data(struct lgs8gxx_state *priv) |
578 | { |
579 | const struct firmware *fw; |
580 | int rc; |
581 | int i; |
582 | |
583 | rc = request_firmware(fw: &fw, LGS8GXX_FIRMWARE, device: &priv->i2c->dev); |
584 | if (rc) |
585 | return rc; |
586 | |
587 | lgs8gxx_write_reg(priv, reg: 0xC6, data: 0x40); |
588 | |
589 | lgs8gxx_write_reg(priv, reg: 0x3D, data: 0x04); |
590 | lgs8gxx_write_reg(priv, reg: 0x39, data: 0x00); |
591 | |
592 | lgs8gxx_write_reg(priv, reg: 0x3A, data: 0x00); |
593 | lgs8gxx_write_reg(priv, reg: 0x38, data: 0x00); |
594 | lgs8gxx_write_reg(priv, reg: 0x3B, data: 0x00); |
595 | lgs8gxx_write_reg(priv, reg: 0x38, data: 0x00); |
596 | |
597 | for (i = 0; i < fw->size; i++) { |
598 | lgs8gxx_write_reg(priv, reg: 0x38, data: 0x00); |
599 | lgs8gxx_write_reg(priv, reg: 0x3A, data: (u8)(i&0xff)); |
600 | lgs8gxx_write_reg(priv, reg: 0x3B, data: (u8)(i>>8)); |
601 | lgs8gxx_write_reg(priv, reg: 0x3C, data: fw->data[i]); |
602 | } |
603 | |
604 | lgs8gxx_write_reg(priv, reg: 0x38, data: 0x00); |
605 | |
606 | release_firmware(fw); |
607 | return 0; |
608 | } |
609 | |
610 | static int lgs8gxx_init(struct dvb_frontend *fe) |
611 | { |
612 | struct lgs8gxx_state *priv = |
613 | (struct lgs8gxx_state *)fe->demodulator_priv; |
614 | const struct lgs8gxx_config *config = priv->config; |
615 | u8 data = 0; |
616 | s8 err; |
617 | dprintk("%s\n" , __func__); |
618 | |
619 | lgs8gxx_read_reg(priv, reg: 0, p_data: &data); |
620 | dprintk("reg 0 = 0x%02X\n" , data); |
621 | |
622 | if (config->prod == LGS8GXX_PROD_LGS8G75) |
623 | lgs8g75_set_adc_vpp(priv, sel: config->adc_vpp); |
624 | |
625 | /* Setup MPEG output format */ |
626 | err = lgs8gxx_set_mpeg_mode(priv, serial: config->serial_ts, |
627 | clk_pol: config->ts_clk_pol, |
628 | clk_gated: config->ts_clk_gated); |
629 | if (err != 0) |
630 | return -EIO; |
631 | |
632 | if (config->prod == LGS8GXX_PROD_LGS8913) |
633 | lgs8913_init(priv); |
634 | lgs8gxx_set_if_freq(priv, freq: priv->config->if_freq); |
635 | lgs8gxx_set_ad_mode(priv); |
636 | |
637 | return 0; |
638 | } |
639 | |
640 | static void lgs8gxx_release(struct dvb_frontend *fe) |
641 | { |
642 | struct lgs8gxx_state *state = fe->demodulator_priv; |
643 | dprintk("%s\n" , __func__); |
644 | |
645 | kfree(objp: state); |
646 | } |
647 | |
648 | |
649 | static int lgs8gxx_write(struct dvb_frontend *fe, const u8 buf[], int len) |
650 | { |
651 | struct lgs8gxx_state *priv = fe->demodulator_priv; |
652 | |
653 | if (len != 2) |
654 | return -EINVAL; |
655 | |
656 | return lgs8gxx_write_reg(priv, reg: buf[0], data: buf[1]); |
657 | } |
658 | |
659 | static int lgs8gxx_set_fe(struct dvb_frontend *fe) |
660 | { |
661 | struct dtv_frontend_properties *fe_params = &fe->dtv_property_cache; |
662 | struct lgs8gxx_state *priv = fe->demodulator_priv; |
663 | |
664 | dprintk("%s\n" , __func__); |
665 | |
666 | /* set frequency */ |
667 | if (fe->ops.tuner_ops.set_params) { |
668 | fe->ops.tuner_ops.set_params(fe); |
669 | if (fe->ops.i2c_gate_ctrl) |
670 | fe->ops.i2c_gate_ctrl(fe, 0); |
671 | } |
672 | |
673 | /* start auto lock */ |
674 | lgs8gxx_auto_lock(priv); |
675 | |
676 | msleep(msecs: 10); |
677 | |
678 | /* TODO: get real readings from device */ |
679 | |
680 | /* bandwidth */ |
681 | fe_params->bandwidth_hz = 8000000; |
682 | |
683 | fe_params->code_rate_HP = FEC_AUTO; |
684 | fe_params->code_rate_LP = FEC_AUTO; |
685 | |
686 | fe_params->modulation = QAM_AUTO; |
687 | |
688 | /* transmission mode */ |
689 | fe_params->transmission_mode = TRANSMISSION_MODE_AUTO; |
690 | |
691 | /* guard interval */ |
692 | fe_params->guard_interval = GUARD_INTERVAL_AUTO; |
693 | |
694 | /* hierarchy */ |
695 | fe_params->hierarchy = HIERARCHY_NONE; |
696 | |
697 | return 0; |
698 | } |
699 | |
700 | static |
701 | int lgs8gxx_get_tune_settings(struct dvb_frontend *fe, |
702 | struct dvb_frontend_tune_settings *fesettings) |
703 | { |
704 | /* FIXME: copy from tda1004x.c */ |
705 | fesettings->min_delay_ms = 800; |
706 | fesettings->step_size = 0; |
707 | fesettings->max_drift = 0; |
708 | return 0; |
709 | } |
710 | |
711 | static int lgs8gxx_read_status(struct dvb_frontend *fe, |
712 | enum fe_status *fe_status) |
713 | { |
714 | struct lgs8gxx_state *priv = fe->demodulator_priv; |
715 | s8 ret; |
716 | u8 t, locked = 0; |
717 | |
718 | dprintk("%s\n" , __func__); |
719 | *fe_status = 0; |
720 | |
721 | lgs8gxx_get_afc_phase(priv); |
722 | lgs8gxx_is_locked(priv, locked: &locked); |
723 | if (priv->config->prod == LGS8GXX_PROD_LGS8G75) { |
724 | if (locked) |
725 | *fe_status |= FE_HAS_SIGNAL | FE_HAS_CARRIER | |
726 | FE_HAS_VITERBI | FE_HAS_SYNC | FE_HAS_LOCK; |
727 | return 0; |
728 | } |
729 | |
730 | ret = lgs8gxx_read_reg(priv, reg: 0x4B, p_data: &t); |
731 | if (ret != 0) |
732 | return -EIO; |
733 | |
734 | dprintk("Reg 0x4B: 0x%02X\n" , t); |
735 | |
736 | *fe_status = 0; |
737 | if (priv->config->prod == LGS8GXX_PROD_LGS8913) { |
738 | if ((t & 0x40) == 0x40) |
739 | *fe_status |= FE_HAS_SIGNAL | FE_HAS_CARRIER; |
740 | if ((t & 0x80) == 0x80) |
741 | *fe_status |= FE_HAS_VITERBI | FE_HAS_SYNC | |
742 | FE_HAS_LOCK; |
743 | } else { |
744 | if ((t & 0x80) == 0x80) |
745 | *fe_status |= FE_HAS_SIGNAL | FE_HAS_CARRIER | |
746 | FE_HAS_VITERBI | FE_HAS_SYNC | FE_HAS_LOCK; |
747 | } |
748 | |
749 | /* success */ |
750 | dprintk("%s: fe_status=0x%x\n" , __func__, *fe_status); |
751 | return 0; |
752 | } |
753 | |
754 | static int lgs8gxx_read_signal_agc(struct lgs8gxx_state *priv, u16 *signal) |
755 | { |
756 | u16 v; |
757 | u8 agc_lvl[2], cat; |
758 | |
759 | dprintk("%s()\n" , __func__); |
760 | lgs8gxx_read_reg(priv, reg: 0x3F, p_data: &agc_lvl[0]); |
761 | lgs8gxx_read_reg(priv, reg: 0x3E, p_data: &agc_lvl[1]); |
762 | |
763 | v = agc_lvl[0]; |
764 | v <<= 8; |
765 | v |= agc_lvl[1]; |
766 | |
767 | dprintk("agc_lvl: 0x%04X\n" , v); |
768 | |
769 | if (v < 0x100) |
770 | cat = 0; |
771 | else if (v < 0x190) |
772 | cat = 5; |
773 | else if (v < 0x2A8) |
774 | cat = 4; |
775 | else if (v < 0x381) |
776 | cat = 3; |
777 | else if (v < 0x400) |
778 | cat = 2; |
779 | else if (v == 0x400) |
780 | cat = 1; |
781 | else |
782 | cat = 0; |
783 | |
784 | *signal = cat * 65535 / 5; |
785 | |
786 | return 0; |
787 | } |
788 | |
789 | static int lgs8913_read_signal_strength(struct lgs8gxx_state *priv, u16 *signal) |
790 | { |
791 | u8 t; s8 ret; |
792 | s16 max_strength = 0; |
793 | u8 str; |
794 | u16 i, gi = priv->curr_gi; |
795 | |
796 | dprintk("%s\n" , __func__); |
797 | |
798 | ret = lgs8gxx_read_reg(priv, reg: 0x4B, p_data: &t); |
799 | if (ret != 0) |
800 | return -EIO; |
801 | |
802 | if (fake_signal_str) { |
803 | if ((t & 0xC0) == 0xC0) { |
804 | dprintk("Fake signal strength\n" ); |
805 | *signal = 0x7FFF; |
806 | } else |
807 | *signal = 0; |
808 | return 0; |
809 | } |
810 | |
811 | dprintk("gi = %d\n" , gi); |
812 | for (i = 0; i < gi; i++) { |
813 | |
814 | if ((i & 0xFF) == 0) |
815 | lgs8gxx_write_reg(priv, reg: 0x84, data: 0x03 & (i >> 8)); |
816 | lgs8gxx_write_reg(priv, reg: 0x83, data: i & 0xFF); |
817 | |
818 | lgs8gxx_read_reg(priv, reg: 0x94, p_data: &str); |
819 | if (max_strength < str) |
820 | max_strength = str; |
821 | } |
822 | |
823 | *signal = max_strength; |
824 | dprintk("%s: signal=0x%02X\n" , __func__, *signal); |
825 | |
826 | lgs8gxx_read_reg(priv, reg: 0x95, p_data: &t); |
827 | dprintk("%s: AVG Noise=0x%02X\n" , __func__, t); |
828 | |
829 | return 0; |
830 | } |
831 | |
832 | static int lgs8g75_read_signal_strength(struct lgs8gxx_state *priv, u16 *signal) |
833 | { |
834 | u8 t; |
835 | s16 v = 0; |
836 | |
837 | dprintk("%s\n" , __func__); |
838 | |
839 | lgs8gxx_read_reg(priv, reg: 0xB1, p_data: &t); |
840 | v |= t; |
841 | v <<= 8; |
842 | lgs8gxx_read_reg(priv, reg: 0xB0, p_data: &t); |
843 | v |= t; |
844 | |
845 | *signal = v; |
846 | dprintk("%s: signal=0x%02X\n" , __func__, *signal); |
847 | |
848 | return 0; |
849 | } |
850 | |
851 | static int lgs8gxx_read_signal_strength(struct dvb_frontend *fe, u16 *signal) |
852 | { |
853 | struct lgs8gxx_state *priv = fe->demodulator_priv; |
854 | |
855 | if (priv->config->prod == LGS8GXX_PROD_LGS8913) |
856 | return lgs8913_read_signal_strength(priv, signal); |
857 | else if (priv->config->prod == LGS8GXX_PROD_LGS8G75) |
858 | return lgs8g75_read_signal_strength(priv, signal); |
859 | else |
860 | return lgs8gxx_read_signal_agc(priv, signal); |
861 | } |
862 | |
863 | static int lgs8gxx_read_snr(struct dvb_frontend *fe, u16 *snr) |
864 | { |
865 | struct lgs8gxx_state *priv = fe->demodulator_priv; |
866 | u8 t; |
867 | *snr = 0; |
868 | |
869 | if (priv->config->prod == LGS8GXX_PROD_LGS8G75) |
870 | lgs8gxx_read_reg(priv, reg: 0x34, p_data: &t); |
871 | else |
872 | lgs8gxx_read_reg(priv, reg: 0x95, p_data: &t); |
873 | dprintk("AVG Noise=0x%02X\n" , t); |
874 | *snr = 256 - t; |
875 | *snr <<= 8; |
876 | dprintk("snr=0x%x\n" , *snr); |
877 | |
878 | return 0; |
879 | } |
880 | |
881 | static int lgs8gxx_read_ucblocks(struct dvb_frontend *fe, u32 *ucblocks) |
882 | { |
883 | *ucblocks = 0; |
884 | dprintk("%s: ucblocks=0x%x\n" , __func__, *ucblocks); |
885 | return 0; |
886 | } |
887 | |
888 | static void packet_counter_start(struct lgs8gxx_state *priv) |
889 | { |
890 | u8 orig, t; |
891 | |
892 | if (priv->config->prod == LGS8GXX_PROD_LGS8G75) { |
893 | lgs8gxx_read_reg(priv, reg: 0x30, p_data: &orig); |
894 | orig &= 0xE7; |
895 | t = orig | 0x10; |
896 | lgs8gxx_write_reg(priv, reg: 0x30, data: t); |
897 | t = orig | 0x18; |
898 | lgs8gxx_write_reg(priv, reg: 0x30, data: t); |
899 | t = orig | 0x10; |
900 | lgs8gxx_write_reg(priv, reg: 0x30, data: t); |
901 | } else { |
902 | lgs8gxx_write_reg(priv, reg: 0xC6, data: 0x01); |
903 | lgs8gxx_write_reg(priv, reg: 0xC6, data: 0x41); |
904 | lgs8gxx_write_reg(priv, reg: 0xC6, data: 0x01); |
905 | } |
906 | } |
907 | |
908 | static void packet_counter_stop(struct lgs8gxx_state *priv) |
909 | { |
910 | u8 t; |
911 | |
912 | if (priv->config->prod == LGS8GXX_PROD_LGS8G75) { |
913 | lgs8gxx_read_reg(priv, reg: 0x30, p_data: &t); |
914 | t &= 0xE7; |
915 | lgs8gxx_write_reg(priv, reg: 0x30, data: t); |
916 | } else { |
917 | lgs8gxx_write_reg(priv, reg: 0xC6, data: 0x81); |
918 | } |
919 | } |
920 | |
921 | static int lgs8gxx_read_ber(struct dvb_frontend *fe, u32 *ber) |
922 | { |
923 | struct lgs8gxx_state *priv = fe->demodulator_priv; |
924 | u8 reg_err, reg_total, t; |
925 | u32 total_cnt = 0, err_cnt = 0; |
926 | int i; |
927 | |
928 | dprintk("%s\n" , __func__); |
929 | |
930 | packet_counter_start(priv); |
931 | msleep(msecs: 200); |
932 | packet_counter_stop(priv); |
933 | |
934 | if (priv->config->prod == LGS8GXX_PROD_LGS8G75) { |
935 | reg_total = 0x28; reg_err = 0x2C; |
936 | } else { |
937 | reg_total = 0xD0; reg_err = 0xD4; |
938 | } |
939 | |
940 | for (i = 0; i < 4; i++) { |
941 | total_cnt <<= 8; |
942 | lgs8gxx_read_reg(priv, reg: reg_total+3-i, p_data: &t); |
943 | total_cnt |= t; |
944 | } |
945 | for (i = 0; i < 4; i++) { |
946 | err_cnt <<= 8; |
947 | lgs8gxx_read_reg(priv, reg: reg_err+3-i, p_data: &t); |
948 | err_cnt |= t; |
949 | } |
950 | dprintk("error=%d total=%d\n" , err_cnt, total_cnt); |
951 | |
952 | if (total_cnt == 0) |
953 | *ber = 0; |
954 | else |
955 | *ber = err_cnt * 100 / total_cnt; |
956 | |
957 | dprintk("%s: ber=0x%x\n" , __func__, *ber); |
958 | return 0; |
959 | } |
960 | |
961 | static int lgs8gxx_i2c_gate_ctrl(struct dvb_frontend *fe, int enable) |
962 | { |
963 | struct lgs8gxx_state *priv = fe->demodulator_priv; |
964 | |
965 | if (priv->config->tuner_address == 0) |
966 | return 0; |
967 | if (enable) { |
968 | u8 v = 0x80 | priv->config->tuner_address; |
969 | return lgs8gxx_write_reg(priv, reg: 0x01, data: v); |
970 | } |
971 | return lgs8gxx_write_reg(priv, reg: 0x01, data: 0); |
972 | } |
973 | |
974 | static const struct dvb_frontend_ops lgs8gxx_ops = { |
975 | .delsys = { SYS_DTMB }, |
976 | .info = { |
977 | .name = "Legend Silicon LGS8913/LGS8GXX DMB-TH" , |
978 | .frequency_min_hz = 474 * MHz, |
979 | .frequency_max_hz = 858 * MHz, |
980 | .frequency_stepsize_hz = 10 * kHz, |
981 | .caps = |
982 | FE_CAN_FEC_AUTO | |
983 | FE_CAN_QAM_AUTO | |
984 | FE_CAN_TRANSMISSION_MODE_AUTO | |
985 | FE_CAN_GUARD_INTERVAL_AUTO |
986 | }, |
987 | |
988 | .release = lgs8gxx_release, |
989 | |
990 | .init = lgs8gxx_init, |
991 | .write = lgs8gxx_write, |
992 | .i2c_gate_ctrl = lgs8gxx_i2c_gate_ctrl, |
993 | |
994 | .set_frontend = lgs8gxx_set_fe, |
995 | .get_tune_settings = lgs8gxx_get_tune_settings, |
996 | |
997 | .read_status = lgs8gxx_read_status, |
998 | .read_ber = lgs8gxx_read_ber, |
999 | .read_signal_strength = lgs8gxx_read_signal_strength, |
1000 | .read_snr = lgs8gxx_read_snr, |
1001 | .read_ucblocks = lgs8gxx_read_ucblocks, |
1002 | }; |
1003 | |
1004 | struct dvb_frontend *lgs8gxx_attach(const struct lgs8gxx_config *config, |
1005 | struct i2c_adapter *i2c) |
1006 | { |
1007 | struct lgs8gxx_state *priv = NULL; |
1008 | u8 data = 0; |
1009 | |
1010 | dprintk("%s()\n" , __func__); |
1011 | |
1012 | if (config == NULL || i2c == NULL) |
1013 | return NULL; |
1014 | |
1015 | priv = kzalloc(size: sizeof(struct lgs8gxx_state), GFP_KERNEL); |
1016 | if (priv == NULL) |
1017 | goto error_out; |
1018 | |
1019 | priv->config = config; |
1020 | priv->i2c = i2c; |
1021 | |
1022 | /* check if the demod is there */ |
1023 | if (lgs8gxx_read_reg(priv, reg: 0, p_data: &data) != 0) { |
1024 | dprintk("%s lgs8gxx not found at i2c addr 0x%02X\n" , |
1025 | __func__, priv->config->demod_address); |
1026 | goto error_out; |
1027 | } |
1028 | |
1029 | lgs8gxx_read_reg(priv, reg: 1, p_data: &data); |
1030 | |
1031 | memcpy(&priv->frontend.ops, &lgs8gxx_ops, |
1032 | sizeof(struct dvb_frontend_ops)); |
1033 | priv->frontend.demodulator_priv = priv; |
1034 | |
1035 | if (config->prod == LGS8GXX_PROD_LGS8G75) |
1036 | lgs8g75_init_data(priv); |
1037 | |
1038 | return &priv->frontend; |
1039 | |
1040 | error_out: |
1041 | dprintk("%s() error_out\n" , __func__); |
1042 | kfree(objp: priv); |
1043 | return NULL; |
1044 | |
1045 | } |
1046 | EXPORT_SYMBOL_GPL(lgs8gxx_attach); |
1047 | |
1048 | MODULE_DESCRIPTION("Legend Silicon LGS8913/LGS8GXX DMB-TH demodulator driver" ); |
1049 | MODULE_AUTHOR("David T. L. Wong <davidtlwong@gmail.com>" ); |
1050 | MODULE_LICENSE("GPL" ); |
1051 | MODULE_FIRMWARE(LGS8GXX_FIRMWARE); |
1052 | |