1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * Abilis Systems Single DVB-T Receiver
4 * Copyright (C) 2008 Pierrick Hascoet <pierrick.hascoet@abilis.com>
5 * Copyright (C) 2010 Devin Heitmueller <dheitmueller@kernellabs.com>
6 */
7 #include <linux/kernel.h>
8 #include <linux/errno.h>
9 #include <linux/slab.h>
10 #include <linux/module.h>
11 #include <linux/mm.h>
12 #include <linux/kref.h>
13 #include <linux/uaccess.h>
14 #include <linux/usb.h>
15
16 /* header file for usb device driver*/
17 #include "as102_drv.h"
18 #include "as10x_cmd.h"
19 #include "as102_fe.h"
20 #include "as102_fw.h"
21 #include <media/dvbdev.h>
22
23 int dual_tuner;
24 module_param_named(dual_tuner, dual_tuner, int, 0644);
25 MODULE_PARM_DESC(dual_tuner, "Activate Dual-Tuner config (default: off)");
26
27 static int fw_upload = 1;
28 module_param_named(fw_upload, fw_upload, int, 0644);
29 MODULE_PARM_DESC(fw_upload, "Turn on/off default FW upload (default: on)");
30
31 static int pid_filtering;
32 module_param_named(pid_filtering, pid_filtering, int, 0644);
33 MODULE_PARM_DESC(pid_filtering, "Activate HW PID filtering (default: off)");
34
35 static int ts_auto_disable;
36 module_param_named(ts_auto_disable, ts_auto_disable, int, 0644);
37 MODULE_PARM_DESC(ts_auto_disable, "Stream Auto Enable on FW (default: off)");
38
39 int elna_enable = 1;
40 module_param_named(elna_enable, elna_enable, int, 0644);
41 MODULE_PARM_DESC(elna_enable, "Activate eLNA (default: on)");
42
43 DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
44
as102_stop_stream(struct as102_dev_t * dev)45 static void as102_stop_stream(struct as102_dev_t *dev)
46 {
47 struct as10x_bus_adapter_t *bus_adap;
48
49 if (dev != NULL)
50 bus_adap = &dev->bus_adap;
51 else
52 return;
53
54 if (bus_adap->ops->stop_stream != NULL)
55 bus_adap->ops->stop_stream(dev);
56
57 if (ts_auto_disable) {
58 if (mutex_lock_interruptible(&dev->bus_adap.lock))
59 return;
60
61 if (as10x_cmd_stop_streaming(bus_adap) < 0)
62 dev_dbg(&dev->bus_adap.usb_dev->dev,
63 "as10x_cmd_stop_streaming failed\n");
64
65 mutex_unlock(&dev->bus_adap.lock);
66 }
67 }
68
as102_start_stream(struct as102_dev_t * dev)69 static int as102_start_stream(struct as102_dev_t *dev)
70 {
71 struct as10x_bus_adapter_t *bus_adap;
72 int ret = -EFAULT;
73
74 if (dev != NULL)
75 bus_adap = &dev->bus_adap;
76 else
77 return ret;
78
79 if (bus_adap->ops->start_stream != NULL)
80 ret = bus_adap->ops->start_stream(dev);
81
82 if (ts_auto_disable) {
83 if (mutex_lock_interruptible(&dev->bus_adap.lock))
84 return -EFAULT;
85
86 ret = as10x_cmd_start_streaming(bus_adap);
87
88 mutex_unlock(&dev->bus_adap.lock);
89 }
90
91 return ret;
92 }
93
as10x_pid_filter(struct as102_dev_t * dev,int index,u16 pid,int onoff)94 static int as10x_pid_filter(struct as102_dev_t *dev,
95 int index, u16 pid, int onoff) {
96
97 struct as10x_bus_adapter_t *bus_adap = &dev->bus_adap;
98 int ret = -EFAULT;
99
100 if (mutex_lock_interruptible(&dev->bus_adap.lock)) {
101 dev_dbg(&dev->bus_adap.usb_dev->dev,
102 "amutex_lock_interruptible(lock) failed !\n");
103 return -EBUSY;
104 }
105
106 switch (onoff) {
107 case 0:
108 ret = as10x_cmd_del_PID_filter(bus_adap, (uint16_t) pid);
109 dev_dbg(&dev->bus_adap.usb_dev->dev,
110 "DEL_PID_FILTER([%02d] 0x%04x) ret = %d\n",
111 index, pid, ret);
112 break;
113 case 1:
114 {
115 struct as10x_ts_filter filter;
116
117 filter.type = TS_PID_TYPE_TS;
118 filter.idx = 0xFF;
119 filter.pid = pid;
120
121 ret = as10x_cmd_add_PID_filter(bus_adap, &filter);
122 dev_dbg(&dev->bus_adap.usb_dev->dev,
123 "ADD_PID_FILTER([%02d -> %02d], 0x%04x) ret = %d\n",
124 index, filter.idx, filter.pid, ret);
125 break;
126 }
127 }
128
129 mutex_unlock(&dev->bus_adap.lock);
130 return ret;
131 }
132
as102_dvb_dmx_start_feed(struct dvb_demux_feed * dvbdmxfeed)133 static int as102_dvb_dmx_start_feed(struct dvb_demux_feed *dvbdmxfeed)
134 {
135 int ret = 0;
136 struct dvb_demux *demux = dvbdmxfeed->demux;
137 struct as102_dev_t *as102_dev = demux->priv;
138
139 if (mutex_lock_interruptible(&as102_dev->sem))
140 return -ERESTARTSYS;
141
142 if (pid_filtering)
143 as10x_pid_filter(as102_dev, dvbdmxfeed->index,
144 dvbdmxfeed->pid, 1);
145
146 if (as102_dev->streaming++ == 0)
147 ret = as102_start_stream(as102_dev);
148
149 mutex_unlock(&as102_dev->sem);
150 return ret;
151 }
152
as102_dvb_dmx_stop_feed(struct dvb_demux_feed * dvbdmxfeed)153 static int as102_dvb_dmx_stop_feed(struct dvb_demux_feed *dvbdmxfeed)
154 {
155 struct dvb_demux *demux = dvbdmxfeed->demux;
156 struct as102_dev_t *as102_dev = demux->priv;
157
158 if (mutex_lock_interruptible(&as102_dev->sem))
159 return -ERESTARTSYS;
160
161 if (--as102_dev->streaming == 0)
162 as102_stop_stream(as102_dev);
163
164 if (pid_filtering)
165 as10x_pid_filter(as102_dev, dvbdmxfeed->index,
166 dvbdmxfeed->pid, 0);
167
168 mutex_unlock(&as102_dev->sem);
169 return 0;
170 }
171
as102_set_tune(void * priv,struct as10x_tune_args * tune_args)172 static int as102_set_tune(void *priv, struct as10x_tune_args *tune_args)
173 {
174 struct as10x_bus_adapter_t *bus_adap = priv;
175 int ret;
176
177 /* Set frontend arguments */
178 if (mutex_lock_interruptible(&bus_adap->lock))
179 return -EBUSY;
180
181 ret = as10x_cmd_set_tune(bus_adap, tune_args);
182 if (ret != 0)
183 dev_dbg(&bus_adap->usb_dev->dev,
184 "as10x_cmd_set_tune failed. (err = %d)\n", ret);
185
186 mutex_unlock(&bus_adap->lock);
187
188 return ret;
189 }
190
as102_get_tps(void * priv,struct as10x_tps * tps)191 static int as102_get_tps(void *priv, struct as10x_tps *tps)
192 {
193 struct as10x_bus_adapter_t *bus_adap = priv;
194 int ret;
195
196 if (mutex_lock_interruptible(&bus_adap->lock))
197 return -EBUSY;
198
199 /* send abilis command: GET_TPS */
200 ret = as10x_cmd_get_tps(bus_adap, tps);
201
202 mutex_unlock(&bus_adap->lock);
203
204 return ret;
205 }
206
as102_get_status(void * priv,struct as10x_tune_status * tstate)207 static int as102_get_status(void *priv, struct as10x_tune_status *tstate)
208 {
209 struct as10x_bus_adapter_t *bus_adap = priv;
210 int ret;
211
212 if (mutex_lock_interruptible(&bus_adap->lock))
213 return -EBUSY;
214
215 /* send abilis command: GET_TUNE_STATUS */
216 ret = as10x_cmd_get_tune_status(bus_adap, tstate);
217 if (ret < 0) {
218 dev_dbg(&bus_adap->usb_dev->dev,
219 "as10x_cmd_get_tune_status failed (err = %d)\n",
220 ret);
221 }
222
223 mutex_unlock(&bus_adap->lock);
224
225 return ret;
226 }
227
as102_get_stats(void * priv,struct as10x_demod_stats * demod_stats)228 static int as102_get_stats(void *priv, struct as10x_demod_stats *demod_stats)
229 {
230 struct as10x_bus_adapter_t *bus_adap = priv;
231 int ret;
232
233 if (mutex_lock_interruptible(&bus_adap->lock))
234 return -EBUSY;
235
236 /* send abilis command: GET_TUNE_STATUS */
237 ret = as10x_cmd_get_demod_stats(bus_adap, demod_stats);
238 if (ret < 0) {
239 dev_dbg(&bus_adap->usb_dev->dev,
240 "as10x_cmd_get_demod_stats failed (probably not tuned)\n");
241 } else {
242 dev_dbg(&bus_adap->usb_dev->dev,
243 "demod status: fc: 0x%08x, bad fc: 0x%08x, bytes corrected: 0x%08x , MER: 0x%04x\n",
244 demod_stats->frame_count,
245 demod_stats->bad_frame_count,
246 demod_stats->bytes_fixed_by_rs,
247 demod_stats->mer);
248 }
249 mutex_unlock(&bus_adap->lock);
250
251 return ret;
252 }
253
as102_stream_ctrl(void * priv,int acquire,uint32_t elna_cfg)254 static int as102_stream_ctrl(void *priv, int acquire, uint32_t elna_cfg)
255 {
256 struct as10x_bus_adapter_t *bus_adap = priv;
257 int ret;
258
259 if (mutex_lock_interruptible(&bus_adap->lock))
260 return -EBUSY;
261
262 if (acquire) {
263 if (elna_enable)
264 as10x_cmd_set_context(bus_adap,
265 CONTEXT_LNA, elna_cfg);
266
267 ret = as10x_cmd_turn_on(bus_adap);
268 } else {
269 ret = as10x_cmd_turn_off(bus_adap);
270 }
271
272 mutex_unlock(&bus_adap->lock);
273
274 return ret;
275 }
276
277 static const struct as102_fe_ops as102_fe_ops = {
278 .set_tune = as102_set_tune,
279 .get_tps = as102_get_tps,
280 .get_status = as102_get_status,
281 .get_stats = as102_get_stats,
282 .stream_ctrl = as102_stream_ctrl,
283 };
284
as102_dvb_register(struct as102_dev_t * as102_dev)285 int as102_dvb_register(struct as102_dev_t *as102_dev)
286 {
287 struct device *dev = &as102_dev->bus_adap.usb_dev->dev;
288 int ret;
289
290 ret = dvb_register_adapter(&as102_dev->dvb_adap,
291 as102_dev->name, THIS_MODULE,
292 dev, adapter_nr);
293 if (ret < 0) {
294 dev_err(dev, "%s: dvb_register_adapter() failed: %d\n",
295 __func__, ret);
296 return ret;
297 }
298
299 as102_dev->dvb_dmx.priv = as102_dev;
300 as102_dev->dvb_dmx.filternum = pid_filtering ? 16 : 256;
301 as102_dev->dvb_dmx.feednum = 256;
302 as102_dev->dvb_dmx.start_feed = as102_dvb_dmx_start_feed;
303 as102_dev->dvb_dmx.stop_feed = as102_dvb_dmx_stop_feed;
304
305 as102_dev->dvb_dmx.dmx.capabilities = DMX_TS_FILTERING |
306 DMX_SECTION_FILTERING;
307
308 as102_dev->dvb_dmxdev.filternum = as102_dev->dvb_dmx.filternum;
309 as102_dev->dvb_dmxdev.demux = &as102_dev->dvb_dmx.dmx;
310 as102_dev->dvb_dmxdev.capabilities = 0;
311
312 ret = dvb_dmx_init(&as102_dev->dvb_dmx);
313 if (ret < 0) {
314 dev_err(dev, "%s: dvb_dmx_init() failed: %d\n", __func__, ret);
315 goto edmxinit;
316 }
317
318 ret = dvb_dmxdev_init(&as102_dev->dvb_dmxdev, &as102_dev->dvb_adap);
319 if (ret < 0) {
320 dev_err(dev, "%s: dvb_dmxdev_init() failed: %d\n",
321 __func__, ret);
322 goto edmxdinit;
323 }
324
325 /* Attach the frontend */
326 as102_dev->dvb_fe = dvb_attach(as102_attach, as102_dev->name,
327 &as102_fe_ops,
328 &as102_dev->bus_adap,
329 as102_dev->elna_cfg);
330 if (!as102_dev->dvb_fe) {
331 ret = -ENODEV;
332 dev_err(dev, "%s: as102_attach() failed: %d",
333 __func__, ret);
334 goto efereg;
335 }
336
337 ret = dvb_register_frontend(&as102_dev->dvb_adap, as102_dev->dvb_fe);
338 if (ret < 0) {
339 dev_err(dev, "%s: as102_dvb_register_frontend() failed: %d",
340 __func__, ret);
341 goto efereg;
342 }
343
344 /* init bus mutex for token locking */
345 mutex_init(&as102_dev->bus_adap.lock);
346
347 /* init start / stop stream mutex */
348 mutex_init(&as102_dev->sem);
349
350 /*
351 * try to load as102 firmware. If firmware upload failed, we'll be
352 * able to upload it later.
353 */
354 if (fw_upload)
355 try_then_request_module(as102_fw_upload(&as102_dev->bus_adap),
356 "firmware_class");
357
358 pr_info("Registered device %s", as102_dev->name);
359 return 0;
360
361 efereg:
362 dvb_dmxdev_release(&as102_dev->dvb_dmxdev);
363 edmxdinit:
364 dvb_dmx_release(&as102_dev->dvb_dmx);
365 edmxinit:
366 dvb_unregister_adapter(&as102_dev->dvb_adap);
367 return ret;
368 }
369
as102_dvb_unregister(struct as102_dev_t * as102_dev)370 void as102_dvb_unregister(struct as102_dev_t *as102_dev)
371 {
372 /* unregister as102 frontend */
373 dvb_unregister_frontend(as102_dev->dvb_fe);
374
375 /* detach frontend */
376 dvb_frontend_detach(as102_dev->dvb_fe);
377
378 /* unregister demux device */
379 dvb_dmxdev_release(&as102_dev->dvb_dmxdev);
380 dvb_dmx_release(&as102_dev->dvb_dmx);
381
382 /* unregister dvb adapter */
383 dvb_unregister_adapter(&as102_dev->dvb_adap);
384
385 pr_info("Unregistered device %s", as102_dev->name);
386 }
387
388 module_usb_driver(as102_usb_driver);
389
390 /* modinfo details */
391 MODULE_DESCRIPTION(DRIVER_FULL_NAME);
392 MODULE_LICENSE("GPL");
393 MODULE_AUTHOR("Pierrick Hascoet <pierrick.hascoet@abilis.com>");
394