1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17#include <media/dvb_frontend.h>
18
19#include "as102_fe.h"
20
21struct as102_state {
22 struct dvb_frontend frontend;
23 struct as10x_demod_stats demod_stats;
24
25 const struct as102_fe_ops *ops;
26 void *priv;
27 uint8_t elna_cfg;
28
29
30 uint16_t signal_strength;
31
32 uint32_t ber;
33};
34
35static uint8_t as102_fe_get_code_rate(enum fe_code_rate arg)
36{
37 uint8_t c;
38
39 switch (arg) {
40 case FEC_1_2:
41 c = CODE_RATE_1_2;
42 break;
43 case FEC_2_3:
44 c = CODE_RATE_2_3;
45 break;
46 case FEC_3_4:
47 c = CODE_RATE_3_4;
48 break;
49 case FEC_5_6:
50 c = CODE_RATE_5_6;
51 break;
52 case FEC_7_8:
53 c = CODE_RATE_7_8;
54 break;
55 default:
56 c = CODE_RATE_UNKNOWN;
57 break;
58 }
59
60 return c;
61}
62
63static int as102_fe_set_frontend(struct dvb_frontend *fe)
64{
65 struct as102_state *state = fe->demodulator_priv;
66 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
67 struct as10x_tune_args tune_args = { 0 };
68
69
70 tune_args.freq = c->frequency / 1000;
71
72
73 tune_args.interleaving_mode = INTLV_NATIVE;
74
75 switch (c->bandwidth_hz) {
76 case 8000000:
77 tune_args.bandwidth = BW_8_MHZ;
78 break;
79 case 7000000:
80 tune_args.bandwidth = BW_7_MHZ;
81 break;
82 case 6000000:
83 tune_args.bandwidth = BW_6_MHZ;
84 break;
85 default:
86 tune_args.bandwidth = BW_8_MHZ;
87 }
88
89 switch (c->guard_interval) {
90 case GUARD_INTERVAL_1_32:
91 tune_args.guard_interval = GUARD_INT_1_32;
92 break;
93 case GUARD_INTERVAL_1_16:
94 tune_args.guard_interval = GUARD_INT_1_16;
95 break;
96 case GUARD_INTERVAL_1_8:
97 tune_args.guard_interval = GUARD_INT_1_8;
98 break;
99 case GUARD_INTERVAL_1_4:
100 tune_args.guard_interval = GUARD_INT_1_4;
101 break;
102 case GUARD_INTERVAL_AUTO:
103 default:
104 tune_args.guard_interval = GUARD_UNKNOWN;
105 break;
106 }
107
108 switch (c->modulation) {
109 case QPSK:
110 tune_args.modulation = CONST_QPSK;
111 break;
112 case QAM_16:
113 tune_args.modulation = CONST_QAM16;
114 break;
115 case QAM_64:
116 tune_args.modulation = CONST_QAM64;
117 break;
118 default:
119 tune_args.modulation = CONST_UNKNOWN;
120 break;
121 }
122
123 switch (c->transmission_mode) {
124 case TRANSMISSION_MODE_2K:
125 tune_args.transmission_mode = TRANS_MODE_2K;
126 break;
127 case TRANSMISSION_MODE_8K:
128 tune_args.transmission_mode = TRANS_MODE_8K;
129 break;
130 default:
131 tune_args.transmission_mode = TRANS_MODE_UNKNOWN;
132 }
133
134 switch (c->hierarchy) {
135 case HIERARCHY_NONE:
136 tune_args.hierarchy = HIER_NONE;
137 break;
138 case HIERARCHY_1:
139 tune_args.hierarchy = HIER_ALPHA_1;
140 break;
141 case HIERARCHY_2:
142 tune_args.hierarchy = HIER_ALPHA_2;
143 break;
144 case HIERARCHY_4:
145 tune_args.hierarchy = HIER_ALPHA_4;
146 break;
147 case HIERARCHY_AUTO:
148 tune_args.hierarchy = HIER_UNKNOWN;
149 break;
150 }
151
152 pr_debug("as102: tuner parameters: freq: %d bw: 0x%02x gi: 0x%02x\n",
153 c->frequency,
154 tune_args.bandwidth,
155 tune_args.guard_interval);
156
157
158
159
160
161 if ((tune_args.hierarchy != HIER_NONE) &&
162 ((c->code_rate_LP == FEC_NONE) ||
163 (c->code_rate_HP == FEC_NONE))) {
164
165 if (c->code_rate_LP == FEC_NONE) {
166 tune_args.hier_select = HIER_HIGH_PRIORITY;
167 tune_args.code_rate =
168 as102_fe_get_code_rate(c->code_rate_HP);
169 }
170
171 if (c->code_rate_HP == FEC_NONE) {
172 tune_args.hier_select = HIER_LOW_PRIORITY;
173 tune_args.code_rate =
174 as102_fe_get_code_rate(c->code_rate_LP);
175 }
176
177 pr_debug("as102: \thierarchy: 0x%02x selected: %s code_rate_%s: 0x%02x\n",
178 tune_args.hierarchy,
179 tune_args.hier_select == HIER_HIGH_PRIORITY ?
180 "HP" : "LP",
181 tune_args.hier_select == HIER_HIGH_PRIORITY ?
182 "HP" : "LP",
183 tune_args.code_rate);
184 } else {
185 tune_args.code_rate =
186 as102_fe_get_code_rate(c->code_rate_HP);
187 }
188
189
190 return state->ops->set_tune(state->priv, &tune_args);
191}
192
193static int as102_fe_get_frontend(struct dvb_frontend *fe,
194 struct dtv_frontend_properties *c)
195{
196 struct as102_state *state = fe->demodulator_priv;
197 int ret = 0;
198 struct as10x_tps tps = { 0 };
199
200
201 ret = state->ops->get_tps(state->priv, &tps);
202 if (ret < 0)
203 return ret;
204
205
206 switch (tps.modulation) {
207 case CONST_QPSK:
208 c->modulation = QPSK;
209 break;
210 case CONST_QAM16:
211 c->modulation = QAM_16;
212 break;
213 case CONST_QAM64:
214 c->modulation = QAM_64;
215 break;
216 }
217
218
219 switch (tps.hierarchy) {
220 case HIER_NONE:
221 c->hierarchy = HIERARCHY_NONE;
222 break;
223 case HIER_ALPHA_1:
224 c->hierarchy = HIERARCHY_1;
225 break;
226 case HIER_ALPHA_2:
227 c->hierarchy = HIERARCHY_2;
228 break;
229 case HIER_ALPHA_4:
230 c->hierarchy = HIERARCHY_4;
231 break;
232 }
233
234
235 switch (tps.code_rate_HP) {
236 case CODE_RATE_1_2:
237 c->code_rate_HP = FEC_1_2;
238 break;
239 case CODE_RATE_2_3:
240 c->code_rate_HP = FEC_2_3;
241 break;
242 case CODE_RATE_3_4:
243 c->code_rate_HP = FEC_3_4;
244 break;
245 case CODE_RATE_5_6:
246 c->code_rate_HP = FEC_5_6;
247 break;
248 case CODE_RATE_7_8:
249 c->code_rate_HP = FEC_7_8;
250 break;
251 }
252
253
254 switch (tps.code_rate_LP) {
255 case CODE_RATE_1_2:
256 c->code_rate_LP = FEC_1_2;
257 break;
258 case CODE_RATE_2_3:
259 c->code_rate_LP = FEC_2_3;
260 break;
261 case CODE_RATE_3_4:
262 c->code_rate_LP = FEC_3_4;
263 break;
264 case CODE_RATE_5_6:
265 c->code_rate_LP = FEC_5_6;
266 break;
267 case CODE_RATE_7_8:
268 c->code_rate_LP = FEC_7_8;
269 break;
270 }
271
272
273 switch (tps.guard_interval) {
274 case GUARD_INT_1_32:
275 c->guard_interval = GUARD_INTERVAL_1_32;
276 break;
277 case GUARD_INT_1_16:
278 c->guard_interval = GUARD_INTERVAL_1_16;
279 break;
280 case GUARD_INT_1_8:
281 c->guard_interval = GUARD_INTERVAL_1_8;
282 break;
283 case GUARD_INT_1_4:
284 c->guard_interval = GUARD_INTERVAL_1_4;
285 break;
286 }
287
288
289 switch (tps.transmission_mode) {
290 case TRANS_MODE_2K:
291 c->transmission_mode = TRANSMISSION_MODE_2K;
292 break;
293 case TRANS_MODE_8K:
294 c->transmission_mode = TRANSMISSION_MODE_8K;
295 break;
296 }
297
298 return 0;
299}
300
301static int as102_fe_get_tune_settings(struct dvb_frontend *fe,
302 struct dvb_frontend_tune_settings *settings) {
303
304 settings->min_delay_ms = 1000;
305
306 return 0;
307}
308
309static int as102_fe_read_status(struct dvb_frontend *fe, enum fe_status *status)
310{
311 int ret = 0;
312 struct as102_state *state = fe->demodulator_priv;
313 struct as10x_tune_status tstate = { 0 };
314
315
316 ret = state->ops->get_status(state->priv, &tstate);
317 if (ret < 0)
318 return ret;
319
320 state->signal_strength = tstate.signal_strength;
321 state->ber = tstate.BER;
322
323 switch (tstate.tune_state) {
324 case TUNE_STATUS_SIGNAL_DVB_OK:
325 *status = FE_HAS_SIGNAL | FE_HAS_CARRIER;
326 break;
327 case TUNE_STATUS_STREAM_DETECTED:
328 *status = FE_HAS_SIGNAL | FE_HAS_CARRIER | FE_HAS_SYNC |
329 FE_HAS_VITERBI;
330 break;
331 case TUNE_STATUS_STREAM_TUNED:
332 *status = FE_HAS_SIGNAL | FE_HAS_CARRIER | FE_HAS_SYNC |
333 FE_HAS_LOCK | FE_HAS_VITERBI;
334 break;
335 default:
336 *status = TUNE_STATUS_NOT_TUNED;
337 }
338
339 pr_debug("as102: tuner status: 0x%02x, strength %d, per: %d, ber: %d\n",
340 tstate.tune_state, tstate.signal_strength,
341 tstate.PER, tstate.BER);
342
343 if (!(*status & FE_HAS_LOCK)) {
344 memset(&state->demod_stats, 0, sizeof(state->demod_stats));
345 return 0;
346 }
347
348 ret = state->ops->get_stats(state->priv, &state->demod_stats);
349 if (ret < 0)
350 memset(&state->demod_stats, 0, sizeof(state->demod_stats));
351
352 return ret;
353}
354
355
356
357
358
359
360
361
362static int as102_fe_read_snr(struct dvb_frontend *fe, u16 *snr)
363{
364 struct as102_state *state = fe->demodulator_priv;
365
366 *snr = state->demod_stats.mer;
367
368 return 0;
369}
370
371static int as102_fe_read_ber(struct dvb_frontend *fe, u32 *ber)
372{
373 struct as102_state *state = fe->demodulator_priv;
374
375 *ber = state->ber;
376
377 return 0;
378}
379
380static int as102_fe_read_signal_strength(struct dvb_frontend *fe,
381 u16 *strength)
382{
383 struct as102_state *state = fe->demodulator_priv;
384
385 *strength = (((0xffff * 400) * state->signal_strength + 41000) * 2);
386
387 return 0;
388}
389
390static int as102_fe_read_ucblocks(struct dvb_frontend *fe, u32 *ucblocks)
391{
392 struct as102_state *state = fe->demodulator_priv;
393
394 if (state->demod_stats.has_started)
395 *ucblocks = state->demod_stats.bad_frame_count;
396 else
397 *ucblocks = 0;
398
399 return 0;
400}
401
402static int as102_fe_ts_bus_ctrl(struct dvb_frontend *fe, int acquire)
403{
404 struct as102_state *state = fe->demodulator_priv;
405
406 return state->ops->stream_ctrl(state->priv, acquire,
407 state->elna_cfg);
408}
409
410static void as102_fe_release(struct dvb_frontend *fe)
411{
412 struct as102_state *state = fe->demodulator_priv;
413
414 kfree(state);
415}
416
417
418static const struct dvb_frontend_ops as102_fe_ops = {
419 .delsys = { SYS_DVBT },
420 .info = {
421 .name = "Abilis AS102 DVB-T",
422 .frequency_min = 174000000,
423 .frequency_max = 862000000,
424 .frequency_stepsize = 166667,
425 .caps = FE_CAN_INVERSION_AUTO
426 | FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 | FE_CAN_FEC_3_4
427 | FE_CAN_FEC_5_6 | FE_CAN_FEC_7_8 | FE_CAN_FEC_AUTO
428 | FE_CAN_QAM_16 | FE_CAN_QAM_64 | FE_CAN_QPSK
429 | FE_CAN_QAM_AUTO
430 | FE_CAN_TRANSMISSION_MODE_AUTO
431 | FE_CAN_GUARD_INTERVAL_AUTO
432 | FE_CAN_HIERARCHY_AUTO
433 | FE_CAN_RECOVER
434 | FE_CAN_MUTE_TS
435 },
436
437 .set_frontend = as102_fe_set_frontend,
438 .get_frontend = as102_fe_get_frontend,
439 .get_tune_settings = as102_fe_get_tune_settings,
440
441 .read_status = as102_fe_read_status,
442 .read_snr = as102_fe_read_snr,
443 .read_ber = as102_fe_read_ber,
444 .read_signal_strength = as102_fe_read_signal_strength,
445 .read_ucblocks = as102_fe_read_ucblocks,
446 .ts_bus_ctrl = as102_fe_ts_bus_ctrl,
447 .release = as102_fe_release,
448};
449
450struct dvb_frontend *as102_attach(const char *name,
451 const struct as102_fe_ops *ops,
452 void *priv,
453 uint8_t elna_cfg)
454{
455 struct as102_state *state;
456 struct dvb_frontend *fe;
457
458 state = kzalloc(sizeof(*state), GFP_KERNEL);
459 if (!state)
460 return NULL;
461
462 fe = &state->frontend;
463 fe->demodulator_priv = state;
464 state->ops = ops;
465 state->priv = priv;
466 state->elna_cfg = elna_cfg;
467
468
469 memcpy(&fe->ops, &as102_fe_ops, sizeof(struct dvb_frontend_ops));
470 strncpy(fe->ops.info.name, name, sizeof(fe->ops.info.name));
471
472 return fe;
473
474}
475EXPORT_SYMBOL_GPL(as102_attach);
476
477MODULE_DESCRIPTION("as102-fe");
478MODULE_LICENSE("GPL");
479MODULE_AUTHOR("Pierrick Hascoet <pierrick.hascoet@abilis.com>");
480
