| /* |
| * Abilis Systems Single DVB-T Receiver |
| * Copyright (C) 2008 Pierrick Hascoet <pierrick.hascoet@abilis.com> |
| * Copyright (C) 2010 Devin Heitmueller <dheitmueller@kernellabs.com> |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License as published by |
| * the Free Software Foundation; either version 2, or (at your option) |
| * any later version. |
| * |
| * This program is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| */ |
| #include <linux/kernel.h> |
| #include <linux/errno.h> |
| #include <linux/slab.h> |
| #include <linux/module.h> |
| #include <linux/mm.h> |
| #include <linux/kref.h> |
| #include <linux/uaccess.h> |
| #include <linux/usb.h> |
| |
| /* header file for usb device driver*/ |
| #include "as102_drv.h" |
| #include "as10x_cmd.h" |
| #include "as102_fe.h" |
| #include "as102_fw.h" |
| #include <media/dvbdev.h> |
| |
| int dual_tuner; |
| module_param_named(dual_tuner, dual_tuner, int, 0644); |
| MODULE_PARM_DESC(dual_tuner, "Activate Dual-Tuner config (default: off)"); |
| |
| static int fw_upload = 1; |
| module_param_named(fw_upload, fw_upload, int, 0644); |
| MODULE_PARM_DESC(fw_upload, "Turn on/off default FW upload (default: on)"); |
| |
| static int pid_filtering; |
| module_param_named(pid_filtering, pid_filtering, int, 0644); |
| MODULE_PARM_DESC(pid_filtering, "Activate HW PID filtering (default: off)"); |
| |
| static int ts_auto_disable; |
| module_param_named(ts_auto_disable, ts_auto_disable, int, 0644); |
| MODULE_PARM_DESC(ts_auto_disable, "Stream Auto Enable on FW (default: off)"); |
| |
| int elna_enable = 1; |
| module_param_named(elna_enable, elna_enable, int, 0644); |
| MODULE_PARM_DESC(elna_enable, "Activate eLNA (default: on)"); |
| |
| DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr); |
| |
| static void as102_stop_stream(struct as102_dev_t *dev) |
| { |
| struct as10x_bus_adapter_t *bus_adap; |
| |
| if (dev != NULL) |
| bus_adap = &dev->bus_adap; |
| else |
| return; |
| |
| if (bus_adap->ops->stop_stream != NULL) |
| bus_adap->ops->stop_stream(dev); |
| |
| if (ts_auto_disable) { |
| if (mutex_lock_interruptible(&dev->bus_adap.lock)) |
| return; |
| |
| if (as10x_cmd_stop_streaming(bus_adap) < 0) |
| dev_dbg(&dev->bus_adap.usb_dev->dev, |
| "as10x_cmd_stop_streaming failed\n"); |
| |
| mutex_unlock(&dev->bus_adap.lock); |
| } |
| } |
| |
| static int as102_start_stream(struct as102_dev_t *dev) |
| { |
| struct as10x_bus_adapter_t *bus_adap; |
| int ret = -EFAULT; |
| |
| if (dev != NULL) |
| bus_adap = &dev->bus_adap; |
| else |
| return ret; |
| |
| if (bus_adap->ops->start_stream != NULL) |
| ret = bus_adap->ops->start_stream(dev); |
| |
| if (ts_auto_disable) { |
| if (mutex_lock_interruptible(&dev->bus_adap.lock)) |
| return -EFAULT; |
| |
| ret = as10x_cmd_start_streaming(bus_adap); |
| |
| mutex_unlock(&dev->bus_adap.lock); |
| } |
| |
| return ret; |
| } |
| |
| static int as10x_pid_filter(struct as102_dev_t *dev, |
| int index, u16 pid, int onoff) { |
| |
| struct as10x_bus_adapter_t *bus_adap = &dev->bus_adap; |
| int ret = -EFAULT; |
| |
| if (mutex_lock_interruptible(&dev->bus_adap.lock)) { |
| dev_dbg(&dev->bus_adap.usb_dev->dev, |
| "amutex_lock_interruptible(lock) failed !\n"); |
| return -EBUSY; |
| } |
| |
| switch (onoff) { |
| case 0: |
| ret = as10x_cmd_del_PID_filter(bus_adap, (uint16_t) pid); |
| dev_dbg(&dev->bus_adap.usb_dev->dev, |
| "DEL_PID_FILTER([%02d] 0x%04x) ret = %d\n", |
| index, pid, ret); |
| break; |
| case 1: |
| { |
| struct as10x_ts_filter filter; |
| |
| filter.type = TS_PID_TYPE_TS; |
| filter.idx = 0xFF; |
| filter.pid = pid; |
| |
| ret = as10x_cmd_add_PID_filter(bus_adap, &filter); |
| dev_dbg(&dev->bus_adap.usb_dev->dev, |
| "ADD_PID_FILTER([%02d -> %02d], 0x%04x) ret = %d\n", |
| index, filter.idx, filter.pid, ret); |
| break; |
| } |
| } |
| |
| mutex_unlock(&dev->bus_adap.lock); |
| return ret; |
| } |
| |
| static int as102_dvb_dmx_start_feed(struct dvb_demux_feed *dvbdmxfeed) |
| { |
| int ret = 0; |
| struct dvb_demux *demux = dvbdmxfeed->demux; |
| struct as102_dev_t *as102_dev = demux->priv; |
| |
| if (mutex_lock_interruptible(&as102_dev->sem)) |
| return -ERESTARTSYS; |
| |
| if (pid_filtering) |
| as10x_pid_filter(as102_dev, dvbdmxfeed->index, |
| dvbdmxfeed->pid, 1); |
| |
| if (as102_dev->streaming++ == 0) |
| ret = as102_start_stream(as102_dev); |
| |
| mutex_unlock(&as102_dev->sem); |
| return ret; |
| } |
| |
| static int as102_dvb_dmx_stop_feed(struct dvb_demux_feed *dvbdmxfeed) |
| { |
| struct dvb_demux *demux = dvbdmxfeed->demux; |
| struct as102_dev_t *as102_dev = demux->priv; |
| |
| if (mutex_lock_interruptible(&as102_dev->sem)) |
| return -ERESTARTSYS; |
| |
| if (--as102_dev->streaming == 0) |
| as102_stop_stream(as102_dev); |
| |
| if (pid_filtering) |
| as10x_pid_filter(as102_dev, dvbdmxfeed->index, |
| dvbdmxfeed->pid, 0); |
| |
| mutex_unlock(&as102_dev->sem); |
| return 0; |
| } |
| |
| static int as102_set_tune(void *priv, struct as10x_tune_args *tune_args) |
| { |
| struct as10x_bus_adapter_t *bus_adap = priv; |
| int ret; |
| |
| /* Set frontend arguments */ |
| if (mutex_lock_interruptible(&bus_adap->lock)) |
| return -EBUSY; |
| |
| ret = as10x_cmd_set_tune(bus_adap, tune_args); |
| if (ret != 0) |
| dev_dbg(&bus_adap->usb_dev->dev, |
| "as10x_cmd_set_tune failed. (err = %d)\n", ret); |
| |
| mutex_unlock(&bus_adap->lock); |
| |
| return ret; |
| } |
| |
| static int as102_get_tps(void *priv, struct as10x_tps *tps) |
| { |
| struct as10x_bus_adapter_t *bus_adap = priv; |
| int ret; |
| |
| if (mutex_lock_interruptible(&bus_adap->lock)) |
| return -EBUSY; |
| |
| /* send abilis command: GET_TPS */ |
| ret = as10x_cmd_get_tps(bus_adap, tps); |
| |
| mutex_unlock(&bus_adap->lock); |
| |
| return ret; |
| } |
| |
| static int as102_get_status(void *priv, struct as10x_tune_status *tstate) |
| { |
| struct as10x_bus_adapter_t *bus_adap = priv; |
| int ret; |
| |
| if (mutex_lock_interruptible(&bus_adap->lock)) |
| return -EBUSY; |
| |
| /* send abilis command: GET_TUNE_STATUS */ |
| ret = as10x_cmd_get_tune_status(bus_adap, tstate); |
| if (ret < 0) { |
| dev_dbg(&bus_adap->usb_dev->dev, |
| "as10x_cmd_get_tune_status failed (err = %d)\n", |
| ret); |
| } |
| |
| mutex_unlock(&bus_adap->lock); |
| |
| return ret; |
| } |
| |
| static int as102_get_stats(void *priv, struct as10x_demod_stats *demod_stats) |
| { |
| struct as10x_bus_adapter_t *bus_adap = priv; |
| int ret; |
| |
| if (mutex_lock_interruptible(&bus_adap->lock)) |
| return -EBUSY; |
| |
| /* send abilis command: GET_TUNE_STATUS */ |
| ret = as10x_cmd_get_demod_stats(bus_adap, demod_stats); |
| if (ret < 0) { |
| dev_dbg(&bus_adap->usb_dev->dev, |
| "as10x_cmd_get_demod_stats failed (probably not tuned)\n"); |
| } else { |
| dev_dbg(&bus_adap->usb_dev->dev, |
| "demod status: fc: 0x%08x, bad fc: 0x%08x, bytes corrected: 0x%08x , MER: 0x%04x\n", |
| demod_stats->frame_count, |
| demod_stats->bad_frame_count, |
| demod_stats->bytes_fixed_by_rs, |
| demod_stats->mer); |
| } |
| mutex_unlock(&bus_adap->lock); |
| |
| return ret; |
| } |
| |
| static int as102_stream_ctrl(void *priv, int acquire, uint32_t elna_cfg) |
| { |
| struct as10x_bus_adapter_t *bus_adap = priv; |
| int ret; |
| |
| if (mutex_lock_interruptible(&bus_adap->lock)) |
| return -EBUSY; |
| |
| if (acquire) { |
| if (elna_enable) |
| as10x_cmd_set_context(bus_adap, |
| CONTEXT_LNA, elna_cfg); |
| |
| ret = as10x_cmd_turn_on(bus_adap); |
| } else { |
| ret = as10x_cmd_turn_off(bus_adap); |
| } |
| |
| mutex_unlock(&bus_adap->lock); |
| |
| return ret; |
| } |
| |
| static const struct as102_fe_ops as102_fe_ops = { |
| .set_tune = as102_set_tune, |
| .get_tps = as102_get_tps, |
| .get_status = as102_get_status, |
| .get_stats = as102_get_stats, |
| .stream_ctrl = as102_stream_ctrl, |
| }; |
| |
| int as102_dvb_register(struct as102_dev_t *as102_dev) |
| { |
| struct device *dev = &as102_dev->bus_adap.usb_dev->dev; |
| int ret; |
| |
| ret = dvb_register_adapter(&as102_dev->dvb_adap, |
| as102_dev->name, THIS_MODULE, |
| dev, adapter_nr); |
| if (ret < 0) { |
| dev_err(dev, "%s: dvb_register_adapter() failed: %d\n", |
| __func__, ret); |
| return ret; |
| } |
| |
| as102_dev->dvb_dmx.priv = as102_dev; |
| as102_dev->dvb_dmx.filternum = pid_filtering ? 16 : 256; |
| as102_dev->dvb_dmx.feednum = 256; |
| as102_dev->dvb_dmx.start_feed = as102_dvb_dmx_start_feed; |
| as102_dev->dvb_dmx.stop_feed = as102_dvb_dmx_stop_feed; |
| |
| as102_dev->dvb_dmx.dmx.capabilities = DMX_TS_FILTERING | |
| DMX_SECTION_FILTERING; |
| |
| as102_dev->dvb_dmxdev.filternum = as102_dev->dvb_dmx.filternum; |
| as102_dev->dvb_dmxdev.demux = &as102_dev->dvb_dmx.dmx; |
| as102_dev->dvb_dmxdev.capabilities = 0; |
| |
| ret = dvb_dmx_init(&as102_dev->dvb_dmx); |
| if (ret < 0) { |
| dev_err(dev, "%s: dvb_dmx_init() failed: %d\n", __func__, ret); |
| goto edmxinit; |
| } |
| |
| ret = dvb_dmxdev_init(&as102_dev->dvb_dmxdev, &as102_dev->dvb_adap); |
| if (ret < 0) { |
| dev_err(dev, "%s: dvb_dmxdev_init() failed: %d\n", |
| __func__, ret); |
| goto edmxdinit; |
| } |
| |
| /* Attach the frontend */ |
| as102_dev->dvb_fe = dvb_attach(as102_attach, as102_dev->name, |
| &as102_fe_ops, |
| &as102_dev->bus_adap, |
| as102_dev->elna_cfg); |
| if (!as102_dev->dvb_fe) { |
| ret = -ENODEV; |
| dev_err(dev, "%s: as102_attach() failed: %d", |
| __func__, ret); |
| goto efereg; |
| } |
| |
| ret = dvb_register_frontend(&as102_dev->dvb_adap, as102_dev->dvb_fe); |
| if (ret < 0) { |
| dev_err(dev, "%s: as102_dvb_register_frontend() failed: %d", |
| __func__, ret); |
| goto efereg; |
| } |
| |
| /* init bus mutex for token locking */ |
| mutex_init(&as102_dev->bus_adap.lock); |
| |
| /* init start / stop stream mutex */ |
| mutex_init(&as102_dev->sem); |
| |
| /* |
| * try to load as102 firmware. If firmware upload failed, we'll be |
| * able to upload it later. |
| */ |
| if (fw_upload) |
| try_then_request_module(as102_fw_upload(&as102_dev->bus_adap), |
| "firmware_class"); |
| |
| pr_info("Registered device %s", as102_dev->name); |
| return 0; |
| |
| efereg: |
| dvb_dmxdev_release(&as102_dev->dvb_dmxdev); |
| edmxdinit: |
| dvb_dmx_release(&as102_dev->dvb_dmx); |
| edmxinit: |
| dvb_unregister_adapter(&as102_dev->dvb_adap); |
| return ret; |
| } |
| |
| void as102_dvb_unregister(struct as102_dev_t *as102_dev) |
| { |
| /* unregister as102 frontend */ |
| dvb_unregister_frontend(as102_dev->dvb_fe); |
| |
| /* detach frontend */ |
| dvb_frontend_detach(as102_dev->dvb_fe); |
| |
| /* unregister demux device */ |
| dvb_dmxdev_release(&as102_dev->dvb_dmxdev); |
| dvb_dmx_release(&as102_dev->dvb_dmx); |
| |
| /* unregister dvb adapter */ |
| dvb_unregister_adapter(&as102_dev->dvb_adap); |
| |
| pr_info("Unregistered device %s", as102_dev->name); |
| } |
| |
| module_usb_driver(as102_usb_driver); |
| |
| /* modinfo details */ |
| MODULE_DESCRIPTION(DRIVER_FULL_NAME); |
| MODULE_LICENSE("GPL"); |
| MODULE_AUTHOR("Pierrick Hascoet <pierrick.hascoet@abilis.com>"); |