1// SPDX-License-Identifier: GPL-2.0-or-later
2/*
3 * mxl111sf-demod.c - driver for the MaxLinear MXL111SF DVB-T demodulator
4 *
5 * Copyright (C) 2010-2014 Michael Krufky <mkrufky@linuxtv.org>
6 */
7
8#include "mxl111sf-demod.h"
9#include "mxl111sf-reg.h"
10
11/* debug */
12static int mxl111sf_demod_debug;
13module_param_named(debug, mxl111sf_demod_debug, int, 0644);
14MODULE_PARM_DESC(debug, "set debugging level (1=info (or-able)).");
15
16#define mxl_dbg(fmt, arg...) \
17 if (mxl111sf_demod_debug) \
18 mxl_printk(KERN_DEBUG, fmt, ##arg)
19
20/* ------------------------------------------------------------------------ */
21
22struct mxl111sf_demod_state {
23 struct mxl111sf_state *mxl_state;
24
25 const struct mxl111sf_demod_config *cfg;
26
27 struct dvb_frontend fe;
28};
29
30/* ------------------------------------------------------------------------ */
31
32static int mxl111sf_demod_read_reg(struct mxl111sf_demod_state *state,
33 u8 addr, u8 *data)
34{
35 return (state->cfg->read_reg) ?
36 state->cfg->read_reg(state->mxl_state, addr, data) :
37 -EINVAL;
38}
39
40static int mxl111sf_demod_write_reg(struct mxl111sf_demod_state *state,
41 u8 addr, u8 data)
42{
43 return (state->cfg->write_reg) ?
44 state->cfg->write_reg(state->mxl_state, addr, data) :
45 -EINVAL;
46}
47
48static
49int mxl111sf_demod_program_regs(struct mxl111sf_demod_state *state,
50 struct mxl111sf_reg_ctrl_info *ctrl_reg_info)
51{
52 return (state->cfg->program_regs) ?
53 state->cfg->program_regs(state->mxl_state, ctrl_reg_info) :
54 -EINVAL;
55}
56
57/* ------------------------------------------------------------------------ */
58/* TPS */
59
60static
61int mxl1x1sf_demod_get_tps_code_rate(struct mxl111sf_demod_state *state,
62 enum fe_code_rate *code_rate)
63{
64 u8 val;
65 int ret = mxl111sf_demod_read_reg(state, V6_CODE_RATE_TPS_REG, data: &val);
66 /* bit<2:0> - 000:1/2, 001:2/3, 010:3/4, 011:5/6, 100:7/8 */
67 if (mxl_fail(ret))
68 goto fail;
69
70 switch (val & V6_CODE_RATE_TPS_MASK) {
71 case 0:
72 *code_rate = FEC_1_2;
73 break;
74 case 1:
75 *code_rate = FEC_2_3;
76 break;
77 case 2:
78 *code_rate = FEC_3_4;
79 break;
80 case 3:
81 *code_rate = FEC_5_6;
82 break;
83 case 4:
84 *code_rate = FEC_7_8;
85 break;
86 }
87fail:
88 return ret;
89}
90
91static
92int mxl1x1sf_demod_get_tps_modulation(struct mxl111sf_demod_state *state,
93 enum fe_modulation *modulation)
94{
95 u8 val;
96 int ret = mxl111sf_demod_read_reg(state, V6_MODORDER_TPS_REG, data: &val);
97 /* Constellation, 00 : QPSK, 01 : 16QAM, 10:64QAM */
98 if (mxl_fail(ret))
99 goto fail;
100
101 switch ((val & V6_PARAM_CONSTELLATION_MASK) >> 4) {
102 case 0:
103 *modulation = QPSK;
104 break;
105 case 1:
106 *modulation = QAM_16;
107 break;
108 case 2:
109 *modulation = QAM_64;
110 break;
111 }
112fail:
113 return ret;
114}
115
116static
117int mxl1x1sf_demod_get_tps_guard_fft_mode(struct mxl111sf_demod_state *state,
118 enum fe_transmit_mode *fft_mode)
119{
120 u8 val;
121 int ret = mxl111sf_demod_read_reg(state, V6_MODE_TPS_REG, data: &val);
122 /* FFT Mode, 00:2K, 01:8K, 10:4K */
123 if (mxl_fail(ret))
124 goto fail;
125
126 switch ((val & V6_PARAM_FFT_MODE_MASK) >> 2) {
127 case 0:
128 *fft_mode = TRANSMISSION_MODE_2K;
129 break;
130 case 1:
131 *fft_mode = TRANSMISSION_MODE_8K;
132 break;
133 case 2:
134 *fft_mode = TRANSMISSION_MODE_4K;
135 break;
136 }
137fail:
138 return ret;
139}
140
141static
142int mxl1x1sf_demod_get_tps_guard_interval(struct mxl111sf_demod_state *state,
143 enum fe_guard_interval *guard)
144{
145 u8 val;
146 int ret = mxl111sf_demod_read_reg(state, V6_CP_TPS_REG, data: &val);
147 /* 00:1/32, 01:1/16, 10:1/8, 11:1/4 */
148 if (mxl_fail(ret))
149 goto fail;
150
151 switch ((val & V6_PARAM_GI_MASK) >> 4) {
152 case 0:
153 *guard = GUARD_INTERVAL_1_32;
154 break;
155 case 1:
156 *guard = GUARD_INTERVAL_1_16;
157 break;
158 case 2:
159 *guard = GUARD_INTERVAL_1_8;
160 break;
161 case 3:
162 *guard = GUARD_INTERVAL_1_4;
163 break;
164 }
165fail:
166 return ret;
167}
168
169static
170int mxl1x1sf_demod_get_tps_hierarchy(struct mxl111sf_demod_state *state,
171 enum fe_hierarchy *hierarchy)
172{
173 u8 val;
174 int ret = mxl111sf_demod_read_reg(state, V6_TPS_HIERACHY_REG, data: &val);
175 /* bit<6:4> - 000:Non hierarchy, 001:1, 010:2, 011:4 */
176 if (mxl_fail(ret))
177 goto fail;
178
179 switch ((val & V6_TPS_HIERARCHY_INFO_MASK) >> 6) {
180 case 0:
181 *hierarchy = HIERARCHY_NONE;
182 break;
183 case 1:
184 *hierarchy = HIERARCHY_1;
185 break;
186 case 2:
187 *hierarchy = HIERARCHY_2;
188 break;
189 case 3:
190 *hierarchy = HIERARCHY_4;
191 break;
192 }
193fail:
194 return ret;
195}
196
197/* ------------------------------------------------------------------------ */
198/* LOCKS */
199
200static
201int mxl1x1sf_demod_get_sync_lock_status(struct mxl111sf_demod_state *state,
202 int *sync_lock)
203{
204 u8 val = 0;
205 int ret = mxl111sf_demod_read_reg(state, V6_SYNC_LOCK_REG, data: &val);
206 if (mxl_fail(ret))
207 goto fail;
208 *sync_lock = (val & SYNC_LOCK_MASK) >> 4;
209fail:
210 return ret;
211}
212
213static
214int mxl1x1sf_demod_get_rs_lock_status(struct mxl111sf_demod_state *state,
215 int *rs_lock)
216{
217 u8 val = 0;
218 int ret = mxl111sf_demod_read_reg(state, V6_RS_LOCK_DET_REG, data: &val);
219 if (mxl_fail(ret))
220 goto fail;
221 *rs_lock = (val & RS_LOCK_DET_MASK) >> 3;
222fail:
223 return ret;
224}
225
226static
227int mxl1x1sf_demod_get_tps_lock_status(struct mxl111sf_demod_state *state,
228 int *tps_lock)
229{
230 u8 val = 0;
231 int ret = mxl111sf_demod_read_reg(state, V6_TPS_LOCK_REG, data: &val);
232 if (mxl_fail(ret))
233 goto fail;
234 *tps_lock = (val & V6_PARAM_TPS_LOCK_MASK) >> 6;
235fail:
236 return ret;
237}
238
239static
240int mxl1x1sf_demod_get_fec_lock_status(struct mxl111sf_demod_state *state,
241 int *fec_lock)
242{
243 u8 val = 0;
244 int ret = mxl111sf_demod_read_reg(state, V6_IRQ_STATUS_REG, data: &val);
245 if (mxl_fail(ret))
246 goto fail;
247 *fec_lock = (val & IRQ_MASK_FEC_LOCK) >> 4;
248fail:
249 return ret;
250}
251
252#if 0
253static
254int mxl1x1sf_demod_get_cp_lock_status(struct mxl111sf_demod_state *state,
255 int *cp_lock)
256{
257 u8 val = 0;
258 int ret = mxl111sf_demod_read_reg(state, V6_CP_LOCK_DET_REG, &val);
259 if (mxl_fail(ret))
260 goto fail;
261 *cp_lock = (val & V6_CP_LOCK_DET_MASK) >> 2;
262fail:
263 return ret;
264}
265#endif
266
267static int mxl1x1sf_demod_reset_irq_status(struct mxl111sf_demod_state *state)
268{
269 return mxl111sf_demod_write_reg(state, addr: 0x0e, data: 0xff);
270}
271
272/* ------------------------------------------------------------------------ */
273
274static int mxl111sf_demod_set_frontend(struct dvb_frontend *fe)
275{
276 struct mxl111sf_demod_state *state = fe->demodulator_priv;
277 int ret = 0;
278
279 struct mxl111sf_reg_ctrl_info phy_pll_patch[] = {
280 {0x00, 0xff, 0x01}, /* change page to 1 */
281 {0x40, 0xff, 0x05},
282 {0x40, 0xff, 0x01},
283 {0x41, 0xff, 0xca},
284 {0x41, 0xff, 0xc0},
285 {0x00, 0xff, 0x00}, /* change page to 0 */
286 {0, 0, 0}
287 };
288
289 mxl_dbg("()");
290
291 if (fe->ops.tuner_ops.set_params) {
292 ret = fe->ops.tuner_ops.set_params(fe);
293 if (mxl_fail(ret))
294 goto fail;
295 msleep(msecs: 50);
296 }
297 ret = mxl111sf_demod_program_regs(state, ctrl_reg_info: phy_pll_patch);
298 mxl_fail(ret);
299 msleep(msecs: 50);
300 ret = mxl1x1sf_demod_reset_irq_status(state);
301 mxl_fail(ret);
302 msleep(msecs: 100);
303fail:
304 return ret;
305}
306
307/* ------------------------------------------------------------------------ */
308
309#if 0
310/* resets TS Packet error count */
311/* After setting 7th bit of V5_PER_COUNT_RESET_REG, it should be reset to 0. */
312static
313int mxl1x1sf_demod_reset_packet_error_count(struct mxl111sf_demod_state *state)
314{
315 struct mxl111sf_reg_ctrl_info reset_per_count[] = {
316 {0x20, 0x01, 0x01},
317 {0x20, 0x01, 0x00},
318 {0, 0, 0}
319 };
320 return mxl111sf_demod_program_regs(state, reset_per_count);
321}
322#endif
323
324/* returns TS Packet error count */
325/* PER Count = FEC_PER_COUNT * (2 ** (FEC_PER_SCALE * 4)) */
326static int mxl111sf_demod_read_ucblocks(struct dvb_frontend *fe, u32 *ucblocks)
327{
328 struct mxl111sf_demod_state *state = fe->demodulator_priv;
329 u32 fec_per_count, fec_per_scale;
330 u8 val;
331 int ret;
332
333 *ucblocks = 0;
334
335 /* FEC_PER_COUNT Register */
336 ret = mxl111sf_demod_read_reg(state, V6_FEC_PER_COUNT_REG, data: &val);
337 if (mxl_fail(ret))
338 goto fail;
339
340 fec_per_count = val;
341
342 /* FEC_PER_SCALE Register */
343 ret = mxl111sf_demod_read_reg(state, V6_FEC_PER_SCALE_REG, data: &val);
344 if (mxl_fail(ret))
345 goto fail;
346
347 val &= V6_FEC_PER_SCALE_MASK;
348 val *= 4;
349
350 fec_per_scale = 1 << val;
351
352 fec_per_count *= fec_per_scale;
353
354 *ucblocks = fec_per_count;
355fail:
356 return ret;
357}
358
359#ifdef MXL111SF_DEMOD_ENABLE_CALCULATIONS
360/* FIXME: leaving this enabled breaks the build on some architectures,
361 * and we shouldn't have any floating point math in the kernel, anyway.
362 *
363 * These macros need to be re-written, but it's harmless to simply
364 * return zero for now. */
365#define CALCULATE_BER(avg_errors, count) \
366 ((u32)(avg_errors * 4)/(count*64*188*8))
367#define CALCULATE_SNR(data) \
368 ((u32)((10 * (u32)data / 64) - 2.5))
369#else
370#define CALCULATE_BER(avg_errors, count) 0
371#define CALCULATE_SNR(data) 0
372#endif
373
374static int mxl111sf_demod_read_ber(struct dvb_frontend *fe, u32 *ber)
375{
376 struct mxl111sf_demod_state *state = fe->demodulator_priv;
377 u8 val1, val2, val3;
378 int ret;
379
380 *ber = 0;
381
382 ret = mxl111sf_demod_read_reg(state, V6_RS_AVG_ERRORS_LSB_REG, data: &val1);
383 if (mxl_fail(ret))
384 goto fail;
385 ret = mxl111sf_demod_read_reg(state, V6_RS_AVG_ERRORS_MSB_REG, data: &val2);
386 if (mxl_fail(ret))
387 goto fail;
388 ret = mxl111sf_demod_read_reg(state, V6_N_ACCUMULATE_REG, data: &val3);
389 if (mxl_fail(ret))
390 goto fail;
391
392 *ber = CALCULATE_BER((val1 | (val2 << 8)), val3);
393fail:
394 return ret;
395}
396
397static int mxl111sf_demod_calc_snr(struct mxl111sf_demod_state *state,
398 u16 *snr)
399{
400 u8 val1, val2;
401 int ret;
402
403 *snr = 0;
404
405 ret = mxl111sf_demod_read_reg(state, V6_SNR_RB_LSB_REG, data: &val1);
406 if (mxl_fail(ret))
407 goto fail;
408 ret = mxl111sf_demod_read_reg(state, V6_SNR_RB_MSB_REG, data: &val2);
409 if (mxl_fail(ret))
410 goto fail;
411
412 *snr = CALCULATE_SNR(val1 | ((val2 & 0x03) << 8));
413fail:
414 return ret;
415}
416
417static int mxl111sf_demod_read_snr(struct dvb_frontend *fe, u16 *snr)
418{
419 struct mxl111sf_demod_state *state = fe->demodulator_priv;
420
421 int ret = mxl111sf_demod_calc_snr(state, snr);
422 if (mxl_fail(ret))
423 goto fail;
424
425 *snr /= 10; /* 0.1 dB */
426fail:
427 return ret;
428}
429
430static int mxl111sf_demod_read_status(struct dvb_frontend *fe,
431 enum fe_status *status)
432{
433 struct mxl111sf_demod_state *state = fe->demodulator_priv;
434 int ret, locked, cr_lock, sync_lock, fec_lock;
435
436 *status = 0;
437
438 ret = mxl1x1sf_demod_get_rs_lock_status(state, rs_lock: &locked);
439 if (mxl_fail(ret))
440 goto fail;
441 ret = mxl1x1sf_demod_get_tps_lock_status(state, tps_lock: &cr_lock);
442 if (mxl_fail(ret))
443 goto fail;
444 ret = mxl1x1sf_demod_get_sync_lock_status(state, sync_lock: &sync_lock);
445 if (mxl_fail(ret))
446 goto fail;
447 ret = mxl1x1sf_demod_get_fec_lock_status(state, fec_lock: &fec_lock);
448 if (mxl_fail(ret))
449 goto fail;
450
451 if (locked)
452 *status |= FE_HAS_SIGNAL;
453 if (cr_lock)
454 *status |= FE_HAS_CARRIER;
455 if (sync_lock)
456 *status |= FE_HAS_SYNC;
457 if (fec_lock) /* false positives? */
458 *status |= FE_HAS_VITERBI;
459
460 if ((locked) && (cr_lock) && (sync_lock))
461 *status |= FE_HAS_LOCK;
462fail:
463 return ret;
464}
465
466static int mxl111sf_demod_read_signal_strength(struct dvb_frontend *fe,
467 u16 *signal_strength)
468{
469 struct mxl111sf_demod_state *state = fe->demodulator_priv;
470 enum fe_modulation modulation;
471 int ret;
472 u16 snr;
473
474 ret = mxl111sf_demod_calc_snr(state, snr: &snr);
475 if (ret < 0)
476 return ret;
477 ret = mxl1x1sf_demod_get_tps_modulation(state, modulation: &modulation);
478 if (ret < 0)
479 return ret;
480
481 switch (modulation) {
482 case QPSK:
483 *signal_strength = (snr >= 1300) ?
484 min(65535, snr * 44) : snr * 38;
485 break;
486 case QAM_16:
487 *signal_strength = (snr >= 1500) ?
488 min(65535, snr * 38) : snr * 33;
489 break;
490 case QAM_64:
491 *signal_strength = (snr >= 2000) ?
492 min(65535, snr * 29) : snr * 25;
493 break;
494 default:
495 *signal_strength = 0;
496 return -EINVAL;
497 }
498
499 return 0;
500}
501
502static int mxl111sf_demod_get_frontend(struct dvb_frontend *fe,
503 struct dtv_frontend_properties *p)
504{
505 struct mxl111sf_demod_state *state = fe->demodulator_priv;
506
507 mxl_dbg("()");
508#if 0
509 p->inversion = /* FIXME */ ? INVERSION_ON : INVERSION_OFF;
510#endif
511 if (fe->ops.tuner_ops.get_bandwidth)
512 fe->ops.tuner_ops.get_bandwidth(fe, &p->bandwidth_hz);
513 if (fe->ops.tuner_ops.get_frequency)
514 fe->ops.tuner_ops.get_frequency(fe, &p->frequency);
515 mxl1x1sf_demod_get_tps_code_rate(state, code_rate: &p->code_rate_HP);
516 mxl1x1sf_demod_get_tps_code_rate(state, code_rate: &p->code_rate_LP);
517 mxl1x1sf_demod_get_tps_modulation(state, modulation: &p->modulation);
518 mxl1x1sf_demod_get_tps_guard_fft_mode(state,
519 fft_mode: &p->transmission_mode);
520 mxl1x1sf_demod_get_tps_guard_interval(state,
521 guard: &p->guard_interval);
522 mxl1x1sf_demod_get_tps_hierarchy(state,
523 hierarchy: &p->hierarchy);
524
525 return 0;
526}
527
528static
529int mxl111sf_demod_get_tune_settings(struct dvb_frontend *fe,
530 struct dvb_frontend_tune_settings *tune)
531{
532 tune->min_delay_ms = 1000;
533 return 0;
534}
535
536static void mxl111sf_demod_release(struct dvb_frontend *fe)
537{
538 struct mxl111sf_demod_state *state = fe->demodulator_priv;
539 mxl_dbg("()");
540 kfree(objp: state);
541 fe->demodulator_priv = NULL;
542}
543
544static const struct dvb_frontend_ops mxl111sf_demod_ops = {
545 .delsys = { SYS_DVBT },
546 .info = {
547 .name = "MaxLinear MxL111SF DVB-T demodulator",
548 .frequency_min_hz = 177 * MHz,
549 .frequency_max_hz = 858 * MHz,
550 .frequency_stepsize_hz = 166666,
551 .caps = FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 | FE_CAN_FEC_3_4 |
552 FE_CAN_FEC_5_6 | FE_CAN_FEC_7_8 | FE_CAN_FEC_AUTO |
553 FE_CAN_QPSK | FE_CAN_QAM_16 | FE_CAN_QAM_64 |
554 FE_CAN_QAM_AUTO |
555 FE_CAN_HIERARCHY_AUTO | FE_CAN_GUARD_INTERVAL_AUTO |
556 FE_CAN_TRANSMISSION_MODE_AUTO | FE_CAN_RECOVER
557 },
558 .release = mxl111sf_demod_release,
559#if 0
560 .init = mxl111sf_init,
561 .i2c_gate_ctrl = mxl111sf_i2c_gate_ctrl,
562#endif
563 .set_frontend = mxl111sf_demod_set_frontend,
564 .get_frontend = mxl111sf_demod_get_frontend,
565 .get_tune_settings = mxl111sf_demod_get_tune_settings,
566 .read_status = mxl111sf_demod_read_status,
567 .read_signal_strength = mxl111sf_demod_read_signal_strength,
568 .read_ber = mxl111sf_demod_read_ber,
569 .read_snr = mxl111sf_demod_read_snr,
570 .read_ucblocks = mxl111sf_demod_read_ucblocks,
571};
572
573struct dvb_frontend *mxl111sf_demod_attach(struct mxl111sf_state *mxl_state,
574 const struct mxl111sf_demod_config *cfg)
575{
576 struct mxl111sf_demod_state *state = NULL;
577
578 mxl_dbg("()");
579
580 state = kzalloc(size: sizeof(struct mxl111sf_demod_state), GFP_KERNEL);
581 if (state == NULL)
582 return NULL;
583
584 state->mxl_state = mxl_state;
585 state->cfg = cfg;
586
587 memcpy(&state->fe.ops, &mxl111sf_demod_ops,
588 sizeof(struct dvb_frontend_ops));
589
590 state->fe.demodulator_priv = state;
591 return &state->fe;
592}
593EXPORT_SYMBOL_GPL(mxl111sf_demod_attach);
594
595MODULE_DESCRIPTION("MaxLinear MxL111SF DVB-T demodulator driver");
596MODULE_AUTHOR("Michael Krufky <mkrufky@linuxtv.org>");
597MODULE_LICENSE("GPL");
598MODULE_VERSION("0.1");
599

source code of linux/drivers/media/usb/dvb-usb-v2/mxl111sf-demod.c