1 | // SPDX-License-Identifier: GPL-2.0 |
2 | /* |
3 | * Earthsoft PT3 driver |
4 | * |
5 | * Copyright (C) 2014 Akihiro Tsukada <tskd08@gmail.com> |
6 | */ |
7 | |
8 | #include <linux/freezer.h> |
9 | #include <linux/kernel.h> |
10 | #include <linux/kthread.h> |
11 | #include <linux/mutex.h> |
12 | #include <linux/module.h> |
13 | #include <linux/pci.h> |
14 | #include <linux/string.h> |
15 | #include <linux/sched/signal.h> |
16 | |
17 | #include <media/dmxdev.h> |
18 | #include <media/dvbdev.h> |
19 | #include <media/dvb_demux.h> |
20 | #include <media/dvb_frontend.h> |
21 | |
22 | #include "pt3.h" |
23 | |
24 | DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr); |
25 | |
26 | static bool one_adapter; |
27 | module_param(one_adapter, bool, 0444); |
28 | MODULE_PARM_DESC(one_adapter, "Place FE's together under one adapter." ); |
29 | |
30 | static int num_bufs = 4; |
31 | module_param(num_bufs, int, 0444); |
32 | MODULE_PARM_DESC(num_bufs, "Number of DMA buffer (188KiB) per FE." ); |
33 | |
34 | |
35 | static const struct i2c_algorithm pt3_i2c_algo = { |
36 | .master_xfer = &pt3_i2c_master_xfer, |
37 | .functionality = &pt3_i2c_functionality, |
38 | }; |
39 | |
40 | static const struct pt3_adap_config adap_conf[PT3_NUM_FE] = { |
41 | { |
42 | .demod_info = { |
43 | I2C_BOARD_INFO(TC90522_I2C_DEV_SAT, 0x11), |
44 | }, |
45 | .tuner_info = { |
46 | I2C_BOARD_INFO("qm1d1c0042" , 0x63), |
47 | }, |
48 | .tuner_cfg.qm1d1c0042 = { |
49 | .lpf = 1, |
50 | }, |
51 | .init_freq = 1049480 - 300, |
52 | }, |
53 | { |
54 | .demod_info = { |
55 | I2C_BOARD_INFO(TC90522_I2C_DEV_TER, 0x10), |
56 | }, |
57 | .tuner_info = { |
58 | I2C_BOARD_INFO("mxl301rf" , 0x62), |
59 | }, |
60 | .init_freq = 515142857, |
61 | }, |
62 | { |
63 | .demod_info = { |
64 | I2C_BOARD_INFO(TC90522_I2C_DEV_SAT, 0x13), |
65 | }, |
66 | .tuner_info = { |
67 | I2C_BOARD_INFO("qm1d1c0042" , 0x60), |
68 | }, |
69 | .tuner_cfg.qm1d1c0042 = { |
70 | .lpf = 1, |
71 | }, |
72 | .init_freq = 1049480 + 300, |
73 | }, |
74 | { |
75 | .demod_info = { |
76 | I2C_BOARD_INFO(TC90522_I2C_DEV_TER, 0x12), |
77 | }, |
78 | .tuner_info = { |
79 | I2C_BOARD_INFO("mxl301rf" , 0x61), |
80 | }, |
81 | .init_freq = 521142857, |
82 | }, |
83 | }; |
84 | |
85 | |
86 | struct reg_val { |
87 | u8 reg; |
88 | u8 val; |
89 | }; |
90 | |
91 | static int |
92 | pt3_demod_write(struct pt3_adapter *adap, const struct reg_val *data, int num) |
93 | { |
94 | struct i2c_msg msg; |
95 | int i, ret; |
96 | |
97 | ret = 0; |
98 | msg.addr = adap->i2c_demod->addr; |
99 | msg.flags = 0; |
100 | msg.len = 2; |
101 | for (i = 0; i < num; i++) { |
102 | msg.buf = (u8 *)&data[i]; |
103 | ret = i2c_transfer(adap: adap->i2c_demod->adapter, msgs: &msg, num: 1); |
104 | if (ret == 0) |
105 | ret = -EREMOTE; |
106 | if (ret < 0) |
107 | return ret; |
108 | } |
109 | return 0; |
110 | } |
111 | |
112 | static inline void pt3_lnb_ctrl(struct pt3_board *pt3, bool on) |
113 | { |
114 | iowrite32((on ? 0x0f : 0x0c), pt3->regs[0] + REG_SYSTEM_W); |
115 | } |
116 | |
117 | static inline struct pt3_adapter *pt3_find_adapter(struct dvb_frontend *fe) |
118 | { |
119 | struct pt3_board *pt3; |
120 | int i; |
121 | |
122 | if (one_adapter) { |
123 | pt3 = fe->dvb->priv; |
124 | for (i = 0; i < PT3_NUM_FE; i++) |
125 | if (pt3->adaps[i]->fe == fe) |
126 | return pt3->adaps[i]; |
127 | } |
128 | return container_of(fe->dvb, struct pt3_adapter, dvb_adap); |
129 | } |
130 | |
131 | /* |
132 | * all 4 tuners in PT3 are packaged in a can module (Sharp VA4M6JC2103). |
133 | * it seems that they share the power lines and Amp power line and |
134 | * adaps[3] controls those powers. |
135 | */ |
136 | static int |
137 | pt3_set_tuner_power(struct pt3_board *pt3, bool tuner_on, bool amp_on) |
138 | { |
139 | struct reg_val rv = { 0x1e, 0x99 }; |
140 | |
141 | if (tuner_on) |
142 | rv.val |= 0x40; |
143 | if (amp_on) |
144 | rv.val |= 0x04; |
145 | return pt3_demod_write(adap: pt3->adaps[PT3_NUM_FE - 1], data: &rv, num: 1); |
146 | } |
147 | |
148 | static int pt3_set_lna(struct dvb_frontend *fe) |
149 | { |
150 | struct pt3_adapter *adap; |
151 | struct pt3_board *pt3; |
152 | u32 val; |
153 | int ret; |
154 | |
155 | /* LNA is shared btw. 2 TERR-tuners */ |
156 | |
157 | adap = pt3_find_adapter(fe); |
158 | val = fe->dtv_property_cache.lna; |
159 | if (val == LNA_AUTO || val == adap->cur_lna) |
160 | return 0; |
161 | |
162 | pt3 = adap->dvb_adap.priv; |
163 | if (mutex_lock_interruptible(&pt3->lock)) |
164 | return -ERESTARTSYS; |
165 | if (val) |
166 | pt3->lna_on_cnt++; |
167 | else |
168 | pt3->lna_on_cnt--; |
169 | |
170 | if (val && pt3->lna_on_cnt <= 1) { |
171 | pt3->lna_on_cnt = 1; |
172 | ret = pt3_set_tuner_power(pt3, tuner_on: true, amp_on: true); |
173 | } else if (!val && pt3->lna_on_cnt <= 0) { |
174 | pt3->lna_on_cnt = 0; |
175 | ret = pt3_set_tuner_power(pt3, tuner_on: true, amp_on: false); |
176 | } else |
177 | ret = 0; |
178 | mutex_unlock(lock: &pt3->lock); |
179 | adap->cur_lna = (val != 0); |
180 | return ret; |
181 | } |
182 | |
183 | static int pt3_set_voltage(struct dvb_frontend *fe, enum fe_sec_voltage volt) |
184 | { |
185 | struct pt3_adapter *adap; |
186 | struct pt3_board *pt3; |
187 | bool on; |
188 | |
189 | /* LNB power is shared btw. 2 SAT-tuners */ |
190 | |
191 | adap = pt3_find_adapter(fe); |
192 | on = (volt != SEC_VOLTAGE_OFF); |
193 | if (on == adap->cur_lnb) |
194 | return 0; |
195 | adap->cur_lnb = on; |
196 | pt3 = adap->dvb_adap.priv; |
197 | if (mutex_lock_interruptible(&pt3->lock)) |
198 | return -ERESTARTSYS; |
199 | if (on) |
200 | pt3->lnb_on_cnt++; |
201 | else |
202 | pt3->lnb_on_cnt--; |
203 | |
204 | if (on && pt3->lnb_on_cnt <= 1) { |
205 | pt3->lnb_on_cnt = 1; |
206 | pt3_lnb_ctrl(pt3, on: true); |
207 | } else if (!on && pt3->lnb_on_cnt <= 0) { |
208 | pt3->lnb_on_cnt = 0; |
209 | pt3_lnb_ctrl(pt3, on: false); |
210 | } |
211 | mutex_unlock(lock: &pt3->lock); |
212 | return 0; |
213 | } |
214 | |
215 | /* register values used in pt3_fe_init() */ |
216 | |
217 | static const struct reg_val init0_sat[] = { |
218 | { 0x03, 0x01 }, |
219 | { 0x1e, 0x10 }, |
220 | }; |
221 | static const struct reg_val init0_ter[] = { |
222 | { 0x01, 0x40 }, |
223 | { 0x1c, 0x10 }, |
224 | }; |
225 | static const struct reg_val cfg_sat[] = { |
226 | { 0x1c, 0x15 }, |
227 | { 0x1f, 0x04 }, |
228 | }; |
229 | static const struct reg_val cfg_ter[] = { |
230 | { 0x1d, 0x01 }, |
231 | }; |
232 | |
233 | /* |
234 | * pt3_fe_init: initialize demod sub modules and ISDB-T tuners all at once. |
235 | * |
236 | * As for demod IC (TC90522) and ISDB-T tuners (MxL301RF), |
237 | * the i2c sequences for init'ing them are not public and hidden in a ROM, |
238 | * and include the board specific configurations as well. |
239 | * They are stored in a lump and cannot be taken out / accessed separately, |
240 | * thus cannot be moved to the FE/tuner driver. |
241 | */ |
242 | static int pt3_fe_init(struct pt3_board *pt3) |
243 | { |
244 | int i, ret; |
245 | struct dvb_frontend *fe; |
246 | |
247 | pt3_i2c_reset(pt3); |
248 | ret = pt3_init_all_demods(pt3); |
249 | if (ret < 0) { |
250 | dev_warn(&pt3->pdev->dev, "Failed to init demod chips\n" ); |
251 | return ret; |
252 | } |
253 | |
254 | /* additional config? */ |
255 | for (i = 0; i < PT3_NUM_FE; i++) { |
256 | fe = pt3->adaps[i]->fe; |
257 | |
258 | if (fe->ops.delsys[0] == SYS_ISDBS) |
259 | ret = pt3_demod_write(adap: pt3->adaps[i], |
260 | data: init0_sat, ARRAY_SIZE(init0_sat)); |
261 | else |
262 | ret = pt3_demod_write(adap: pt3->adaps[i], |
263 | data: init0_ter, ARRAY_SIZE(init0_ter)); |
264 | if (ret < 0) { |
265 | dev_warn(&pt3->pdev->dev, |
266 | "demod[%d] failed in init sequence0\n" , i); |
267 | return ret; |
268 | } |
269 | ret = fe->ops.init(fe); |
270 | if (ret < 0) |
271 | return ret; |
272 | } |
273 | |
274 | usleep_range(min: 2000, max: 4000); |
275 | ret = pt3_set_tuner_power(pt3, tuner_on: true, amp_on: false); |
276 | if (ret < 0) { |
277 | dev_warn(&pt3->pdev->dev, "Failed to control tuner module\n" ); |
278 | return ret; |
279 | } |
280 | |
281 | /* output pin configuration */ |
282 | for (i = 0; i < PT3_NUM_FE; i++) { |
283 | fe = pt3->adaps[i]->fe; |
284 | if (fe->ops.delsys[0] == SYS_ISDBS) |
285 | ret = pt3_demod_write(adap: pt3->adaps[i], |
286 | data: cfg_sat, ARRAY_SIZE(cfg_sat)); |
287 | else |
288 | ret = pt3_demod_write(adap: pt3->adaps[i], |
289 | data: cfg_ter, ARRAY_SIZE(cfg_ter)); |
290 | if (ret < 0) { |
291 | dev_warn(&pt3->pdev->dev, |
292 | "demod[%d] failed in init sequence1\n" , i); |
293 | return ret; |
294 | } |
295 | } |
296 | usleep_range(min: 4000, max: 6000); |
297 | |
298 | for (i = 0; i < PT3_NUM_FE; i++) { |
299 | fe = pt3->adaps[i]->fe; |
300 | if (fe->ops.delsys[0] != SYS_ISDBS) |
301 | continue; |
302 | /* init and wake-up ISDB-S tuners */ |
303 | ret = fe->ops.tuner_ops.init(fe); |
304 | if (ret < 0) { |
305 | dev_warn(&pt3->pdev->dev, |
306 | "Failed to init SAT-tuner[%d]\n" , i); |
307 | return ret; |
308 | } |
309 | } |
310 | ret = pt3_init_all_mxl301rf(pt3); |
311 | if (ret < 0) { |
312 | dev_warn(&pt3->pdev->dev, "Failed to init TERR-tuners\n" ); |
313 | return ret; |
314 | } |
315 | |
316 | ret = pt3_set_tuner_power(pt3, tuner_on: true, amp_on: true); |
317 | if (ret < 0) { |
318 | dev_warn(&pt3->pdev->dev, "Failed to control tuner module\n" ); |
319 | return ret; |
320 | } |
321 | |
322 | /* Wake up all tuners and make an initial tuning, |
323 | * in order to avoid interference among the tuners in the module, |
324 | * according to the doc from the manufacturer. |
325 | */ |
326 | for (i = 0; i < PT3_NUM_FE; i++) { |
327 | fe = pt3->adaps[i]->fe; |
328 | ret = 0; |
329 | if (fe->ops.delsys[0] == SYS_ISDBT) |
330 | ret = fe->ops.tuner_ops.init(fe); |
331 | /* set only when called from pt3_probe(), not resume() */ |
332 | if (ret == 0 && fe->dtv_property_cache.frequency == 0) { |
333 | fe->dtv_property_cache.frequency = |
334 | adap_conf[i].init_freq; |
335 | ret = fe->ops.tuner_ops.set_params(fe); |
336 | } |
337 | if (ret < 0) { |
338 | dev_warn(&pt3->pdev->dev, |
339 | "Failed in initial tuning of tuner[%d]\n" , i); |
340 | return ret; |
341 | } |
342 | } |
343 | |
344 | /* and sleep again, waiting to be opened by users. */ |
345 | for (i = 0; i < PT3_NUM_FE; i++) { |
346 | fe = pt3->adaps[i]->fe; |
347 | if (fe->ops.tuner_ops.sleep) |
348 | ret = fe->ops.tuner_ops.sleep(fe); |
349 | if (ret < 0) |
350 | break; |
351 | if (fe->ops.sleep) |
352 | ret = fe->ops.sleep(fe); |
353 | if (ret < 0) |
354 | break; |
355 | if (fe->ops.delsys[0] == SYS_ISDBS) |
356 | fe->ops.set_voltage = &pt3_set_voltage; |
357 | else |
358 | fe->ops.set_lna = &pt3_set_lna; |
359 | } |
360 | if (i < PT3_NUM_FE) { |
361 | dev_warn(&pt3->pdev->dev, "FE[%d] failed to standby\n" , i); |
362 | return ret; |
363 | } |
364 | return 0; |
365 | } |
366 | |
367 | |
368 | static int pt3_attach_fe(struct pt3_board *pt3, int i) |
369 | { |
370 | const struct i2c_board_info *info; |
371 | struct tc90522_config cfg; |
372 | struct i2c_client *cl; |
373 | struct dvb_adapter *dvb_adap; |
374 | int ret; |
375 | |
376 | info = &adap_conf[i].demod_info; |
377 | cfg = adap_conf[i].demod_cfg; |
378 | cfg.tuner_i2c = NULL; |
379 | |
380 | ret = -ENODEV; |
381 | cl = dvb_module_probe(module_name: "tc90522" , name: info->type, adap: &pt3->i2c_adap, |
382 | addr: info->addr, platform_data: &cfg); |
383 | if (!cl) |
384 | return -ENODEV; |
385 | pt3->adaps[i]->i2c_demod = cl; |
386 | |
387 | if (!strncmp(cl->name, TC90522_I2C_DEV_SAT, |
388 | strlen(TC90522_I2C_DEV_SAT))) { |
389 | struct qm1d1c0042_config tcfg; |
390 | |
391 | tcfg = adap_conf[i].tuner_cfg.qm1d1c0042; |
392 | tcfg.fe = cfg.fe; |
393 | info = &adap_conf[i].tuner_info; |
394 | cl = dvb_module_probe(module_name: "qm1d1c0042" , name: info->type, adap: cfg.tuner_i2c, |
395 | addr: info->addr, platform_data: &tcfg); |
396 | } else { |
397 | struct mxl301rf_config tcfg; |
398 | |
399 | tcfg = adap_conf[i].tuner_cfg.mxl301rf; |
400 | tcfg.fe = cfg.fe; |
401 | info = &adap_conf[i].tuner_info; |
402 | cl = dvb_module_probe(module_name: "mxl301rf" , name: info->type, adap: cfg.tuner_i2c, |
403 | addr: info->addr, platform_data: &tcfg); |
404 | } |
405 | if (!cl) |
406 | goto err_demod_module_release; |
407 | pt3->adaps[i]->i2c_tuner = cl; |
408 | |
409 | dvb_adap = &pt3->adaps[one_adapter ? 0 : i]->dvb_adap; |
410 | ret = dvb_register_frontend(dvb: dvb_adap, fe: cfg.fe); |
411 | if (ret < 0) |
412 | goto err_tuner_module_release; |
413 | pt3->adaps[i]->fe = cfg.fe; |
414 | return 0; |
415 | |
416 | err_tuner_module_release: |
417 | dvb_module_release(client: pt3->adaps[i]->i2c_tuner); |
418 | err_demod_module_release: |
419 | dvb_module_release(client: pt3->adaps[i]->i2c_demod); |
420 | |
421 | return ret; |
422 | } |
423 | |
424 | |
425 | static int pt3_fetch_thread(void *data) |
426 | { |
427 | struct pt3_adapter *adap = data; |
428 | ktime_t delay; |
429 | bool was_frozen; |
430 | |
431 | #define PT3_INITIAL_BUF_DROPS 4 |
432 | #define PT3_FETCH_DELAY 10 |
433 | #define PT3_FETCH_DELAY_DELTA 2 |
434 | |
435 | pt3_init_dmabuf(adap); |
436 | adap->num_discard = PT3_INITIAL_BUF_DROPS; |
437 | |
438 | dev_dbg(adap->dvb_adap.device, "PT3: [%s] started\n" , |
439 | adap->thread->comm); |
440 | set_freezable(); |
441 | while (!kthread_freezable_should_stop(was_frozen: &was_frozen)) { |
442 | if (was_frozen) |
443 | adap->num_discard = PT3_INITIAL_BUF_DROPS; |
444 | |
445 | pt3_proc_dma(adap); |
446 | |
447 | delay = ktime_set(secs: 0, PT3_FETCH_DELAY * NSEC_PER_MSEC); |
448 | set_current_state(TASK_UNINTERRUPTIBLE|TASK_FREEZABLE); |
449 | schedule_hrtimeout_range(expires: &delay, |
450 | PT3_FETCH_DELAY_DELTA * NSEC_PER_MSEC, |
451 | mode: HRTIMER_MODE_REL); |
452 | } |
453 | dev_dbg(adap->dvb_adap.device, "PT3: [%s] exited\n" , |
454 | adap->thread->comm); |
455 | return 0; |
456 | } |
457 | |
458 | static int pt3_start_streaming(struct pt3_adapter *adap) |
459 | { |
460 | struct task_struct *thread; |
461 | |
462 | /* start fetching thread */ |
463 | thread = kthread_run(pt3_fetch_thread, adap, "pt3-ad%i-dmx%i" , |
464 | adap->dvb_adap.num, adap->dmxdev.dvbdev->id); |
465 | if (IS_ERR(ptr: thread)) { |
466 | int ret = PTR_ERR(ptr: thread); |
467 | |
468 | adap->thread = NULL; |
469 | dev_warn(adap->dvb_adap.device, |
470 | "PT3 (adap:%d, dmx:%d): failed to start kthread\n" , |
471 | adap->dvb_adap.num, adap->dmxdev.dvbdev->id); |
472 | return ret; |
473 | } |
474 | adap->thread = thread; |
475 | |
476 | return pt3_start_dma(adap); |
477 | } |
478 | |
479 | static int pt3_stop_streaming(struct pt3_adapter *adap) |
480 | { |
481 | int ret; |
482 | |
483 | ret = pt3_stop_dma(adap); |
484 | if (ret) |
485 | dev_warn(adap->dvb_adap.device, |
486 | "PT3: failed to stop streaming of adap:%d/FE:%d\n" , |
487 | adap->dvb_adap.num, adap->fe->id); |
488 | |
489 | /* kill the fetching thread */ |
490 | ret = kthread_stop(k: adap->thread); |
491 | adap->thread = NULL; |
492 | return ret; |
493 | } |
494 | |
495 | static int pt3_start_feed(struct dvb_demux_feed *feed) |
496 | { |
497 | struct pt3_adapter *adap; |
498 | |
499 | if (signal_pending(current)) |
500 | return -EINTR; |
501 | |
502 | adap = container_of(feed->demux, struct pt3_adapter, demux); |
503 | adap->num_feeds++; |
504 | if (adap->num_feeds > 1) |
505 | return 0; |
506 | |
507 | return pt3_start_streaming(adap); |
508 | |
509 | } |
510 | |
511 | static int pt3_stop_feed(struct dvb_demux_feed *feed) |
512 | { |
513 | struct pt3_adapter *adap; |
514 | |
515 | adap = container_of(feed->demux, struct pt3_adapter, demux); |
516 | |
517 | adap->num_feeds--; |
518 | if (adap->num_feeds > 0 || !adap->thread) |
519 | return 0; |
520 | adap->num_feeds = 0; |
521 | |
522 | return pt3_stop_streaming(adap); |
523 | } |
524 | |
525 | |
526 | static int pt3_alloc_adapter(struct pt3_board *pt3, int index) |
527 | { |
528 | int ret; |
529 | struct pt3_adapter *adap; |
530 | struct dvb_adapter *da; |
531 | |
532 | adap = kzalloc(size: sizeof(*adap), GFP_KERNEL); |
533 | if (!adap) |
534 | return -ENOMEM; |
535 | |
536 | pt3->adaps[index] = adap; |
537 | adap->adap_idx = index; |
538 | |
539 | if (index == 0 || !one_adapter) { |
540 | ret = dvb_register_adapter(adap: &adap->dvb_adap, name: "PT3 DVB" , |
541 | THIS_MODULE, device: &pt3->pdev->dev, adapter_nums: adapter_nr); |
542 | if (ret < 0) { |
543 | dev_err(&pt3->pdev->dev, |
544 | "failed to register adapter dev\n" ); |
545 | goto err_mem; |
546 | } |
547 | da = &adap->dvb_adap; |
548 | } else |
549 | da = &pt3->adaps[0]->dvb_adap; |
550 | |
551 | adap->dvb_adap.priv = pt3; |
552 | adap->demux.dmx.capabilities = DMX_TS_FILTERING | DMX_SECTION_FILTERING; |
553 | adap->demux.priv = adap; |
554 | adap->demux.feednum = 256; |
555 | adap->demux.filternum = 256; |
556 | adap->demux.start_feed = pt3_start_feed; |
557 | adap->demux.stop_feed = pt3_stop_feed; |
558 | ret = dvb_dmx_init(demux: &adap->demux); |
559 | if (ret < 0) { |
560 | dev_err(&pt3->pdev->dev, "failed to init dmx dev\n" ); |
561 | goto err_adap; |
562 | } |
563 | |
564 | adap->dmxdev.filternum = 256; |
565 | adap->dmxdev.demux = &adap->demux.dmx; |
566 | ret = dvb_dmxdev_init(dmxdev: &adap->dmxdev, adap: da); |
567 | if (ret < 0) { |
568 | dev_err(&pt3->pdev->dev, "failed to init dmxdev\n" ); |
569 | goto err_demux; |
570 | } |
571 | |
572 | ret = pt3_alloc_dmabuf(adap); |
573 | if (ret) { |
574 | dev_err(&pt3->pdev->dev, "failed to alloc DMA buffers\n" ); |
575 | goto err_dmabuf; |
576 | } |
577 | |
578 | return 0; |
579 | |
580 | err_dmabuf: |
581 | pt3_free_dmabuf(adap); |
582 | dvb_dmxdev_release(dmxdev: &adap->dmxdev); |
583 | err_demux: |
584 | dvb_dmx_release(demux: &adap->demux); |
585 | err_adap: |
586 | if (index == 0 || !one_adapter) |
587 | dvb_unregister_adapter(adap: da); |
588 | err_mem: |
589 | kfree(objp: adap); |
590 | pt3->adaps[index] = NULL; |
591 | return ret; |
592 | } |
593 | |
594 | static void pt3_cleanup_adapter(struct pt3_board *pt3, int index) |
595 | { |
596 | struct pt3_adapter *adap; |
597 | struct dmx_demux *dmx; |
598 | |
599 | adap = pt3->adaps[index]; |
600 | if (adap == NULL) |
601 | return; |
602 | |
603 | /* stop demux kthread */ |
604 | if (adap->thread) |
605 | pt3_stop_streaming(adap); |
606 | |
607 | dmx = &adap->demux.dmx; |
608 | dmx->close(dmx); |
609 | if (adap->fe) { |
610 | adap->fe->callback = NULL; |
611 | if (adap->fe->frontend_priv) |
612 | dvb_unregister_frontend(fe: adap->fe); |
613 | dvb_module_release(client: adap->i2c_tuner); |
614 | dvb_module_release(client: adap->i2c_demod); |
615 | } |
616 | pt3_free_dmabuf(adap); |
617 | dvb_dmxdev_release(dmxdev: &adap->dmxdev); |
618 | dvb_dmx_release(demux: &adap->demux); |
619 | if (index == 0 || !one_adapter) |
620 | dvb_unregister_adapter(adap: &adap->dvb_adap); |
621 | kfree(objp: adap); |
622 | pt3->adaps[index] = NULL; |
623 | } |
624 | |
625 | #ifdef CONFIG_PM_SLEEP |
626 | |
627 | static int pt3_suspend(struct device *dev) |
628 | { |
629 | struct pt3_board *pt3 = dev_get_drvdata(dev); |
630 | int i; |
631 | struct pt3_adapter *adap; |
632 | |
633 | for (i = 0; i < PT3_NUM_FE; i++) { |
634 | adap = pt3->adaps[i]; |
635 | if (adap->num_feeds > 0) |
636 | pt3_stop_dma(adap); |
637 | dvb_frontend_suspend(fe: adap->fe); |
638 | pt3_free_dmabuf(adap); |
639 | } |
640 | |
641 | pt3_lnb_ctrl(pt3, on: false); |
642 | pt3_set_tuner_power(pt3, tuner_on: false, amp_on: false); |
643 | return 0; |
644 | } |
645 | |
646 | static int pt3_resume(struct device *dev) |
647 | { |
648 | struct pt3_board *pt3 = dev_get_drvdata(dev); |
649 | int i, ret; |
650 | struct pt3_adapter *adap; |
651 | |
652 | ret = pt3_fe_init(pt3); |
653 | if (ret) |
654 | return ret; |
655 | |
656 | if (pt3->lna_on_cnt > 0) |
657 | pt3_set_tuner_power(pt3, tuner_on: true, amp_on: true); |
658 | if (pt3->lnb_on_cnt > 0) |
659 | pt3_lnb_ctrl(pt3, on: true); |
660 | |
661 | for (i = 0; i < PT3_NUM_FE; i++) { |
662 | adap = pt3->adaps[i]; |
663 | dvb_frontend_resume(fe: adap->fe); |
664 | ret = pt3_alloc_dmabuf(adap); |
665 | if (ret) { |
666 | dev_err(&pt3->pdev->dev, "failed to alloc DMA bufs\n" ); |
667 | continue; |
668 | } |
669 | if (adap->num_feeds > 0) |
670 | pt3_start_dma(adap); |
671 | } |
672 | |
673 | return 0; |
674 | } |
675 | |
676 | #endif /* CONFIG_PM_SLEEP */ |
677 | |
678 | |
679 | static void pt3_remove(struct pci_dev *pdev) |
680 | { |
681 | struct pt3_board *pt3; |
682 | int i; |
683 | |
684 | pt3 = pci_get_drvdata(pdev); |
685 | for (i = PT3_NUM_FE - 1; i >= 0; i--) |
686 | pt3_cleanup_adapter(pt3, index: i); |
687 | i2c_del_adapter(adap: &pt3->i2c_adap); |
688 | } |
689 | |
690 | static int pt3_probe(struct pci_dev *pdev, const struct pci_device_id *ent) |
691 | { |
692 | u8 rev; |
693 | u32 ver; |
694 | int i, ret; |
695 | struct pt3_board *pt3; |
696 | struct i2c_adapter *i2c; |
697 | |
698 | if (pci_read_config_byte(dev: pdev, PCI_REVISION_ID, val: &rev) || rev != 1) |
699 | return -ENODEV; |
700 | |
701 | ret = pcim_enable_device(pdev); |
702 | if (ret < 0) |
703 | return -ENODEV; |
704 | pci_set_master(dev: pdev); |
705 | |
706 | ret = pcim_iomap_regions(pdev, BIT(0) | BIT(2), DRV_NAME); |
707 | if (ret < 0) |
708 | return ret; |
709 | |
710 | ret = dma_set_mask_and_coherent(dev: &pdev->dev, DMA_BIT_MASK(64)); |
711 | if (ret) { |
712 | dev_err(&pdev->dev, "Failed to set DMA mask\n" ); |
713 | return ret; |
714 | } |
715 | |
716 | pt3 = devm_kzalloc(dev: &pdev->dev, size: sizeof(*pt3), GFP_KERNEL); |
717 | if (!pt3) |
718 | return -ENOMEM; |
719 | pci_set_drvdata(pdev, data: pt3); |
720 | pt3->pdev = pdev; |
721 | mutex_init(&pt3->lock); |
722 | pt3->regs[0] = pcim_iomap_table(pdev)[0]; |
723 | pt3->regs[1] = pcim_iomap_table(pdev)[2]; |
724 | |
725 | ver = ioread32(pt3->regs[0] + REG_VERSION); |
726 | if ((ver >> 16) != 0x0301) { |
727 | dev_warn(&pdev->dev, "PT%d, I/F-ver.:%d not supported\n" , |
728 | ver >> 24, (ver & 0x00ff0000) >> 16); |
729 | return -ENODEV; |
730 | } |
731 | |
732 | pt3->num_bufs = clamp_val(num_bufs, MIN_DATA_BUFS, MAX_DATA_BUFS); |
733 | |
734 | pt3->i2c_buf = devm_kmalloc(dev: &pdev->dev, size: sizeof(*pt3->i2c_buf), GFP_KERNEL); |
735 | if (!pt3->i2c_buf) |
736 | return -ENOMEM; |
737 | i2c = &pt3->i2c_adap; |
738 | i2c->owner = THIS_MODULE; |
739 | i2c->algo = &pt3_i2c_algo; |
740 | i2c->algo_data = NULL; |
741 | i2c->dev.parent = &pdev->dev; |
742 | strscpy(i2c->name, DRV_NAME, sizeof(i2c->name)); |
743 | i2c_set_adapdata(adap: i2c, data: pt3); |
744 | ret = i2c_add_adapter(adap: i2c); |
745 | if (ret < 0) |
746 | return ret; |
747 | |
748 | for (i = 0; i < PT3_NUM_FE; i++) { |
749 | ret = pt3_alloc_adapter(pt3, index: i); |
750 | if (ret < 0) |
751 | break; |
752 | |
753 | ret = pt3_attach_fe(pt3, i); |
754 | if (ret < 0) |
755 | break; |
756 | } |
757 | if (i < PT3_NUM_FE) { |
758 | dev_err(&pdev->dev, "Failed to create FE%d\n" , i); |
759 | goto err_cleanup_adapters; |
760 | } |
761 | |
762 | ret = pt3_fe_init(pt3); |
763 | if (ret < 0) { |
764 | dev_err(&pdev->dev, "Failed to init frontends\n" ); |
765 | i = PT3_NUM_FE - 1; |
766 | goto err_cleanup_adapters; |
767 | } |
768 | |
769 | dev_info(&pdev->dev, |
770 | "successfully init'ed PT%d (fw:0x%02x, I/F:0x%02x)\n" , |
771 | ver >> 24, (ver >> 8) & 0xff, (ver >> 16) & 0xff); |
772 | return 0; |
773 | |
774 | err_cleanup_adapters: |
775 | while (i >= 0) |
776 | pt3_cleanup_adapter(pt3, index: i--); |
777 | i2c_del_adapter(adap: i2c); |
778 | return ret; |
779 | } |
780 | |
781 | static const struct pci_device_id pt3_id_table[] = { |
782 | { PCI_DEVICE_SUB(0x1172, 0x4c15, 0xee8d, 0x0368) }, |
783 | { }, |
784 | }; |
785 | MODULE_DEVICE_TABLE(pci, pt3_id_table); |
786 | |
787 | static SIMPLE_DEV_PM_OPS(pt3_pm_ops, pt3_suspend, pt3_resume); |
788 | |
789 | static struct pci_driver pt3_driver = { |
790 | .name = DRV_NAME, |
791 | .probe = pt3_probe, |
792 | .remove = pt3_remove, |
793 | .id_table = pt3_id_table, |
794 | |
795 | .driver.pm = &pt3_pm_ops, |
796 | }; |
797 | |
798 | module_pci_driver(pt3_driver); |
799 | |
800 | MODULE_DESCRIPTION("Earthsoft PT3 Driver" ); |
801 | MODULE_AUTHOR("Akihiro TSUKADA" ); |
802 | MODULE_LICENSE("GPL" ); |
803 | |