tm6000-dvb.c

Go to the documentation of this file.

/*
 *  tm6000-dvb.c - dvb-t support for TM5600/TM6000/TM6010 USB video capture devices
 *
 *  Copyright (C) 2007 Michel Ludwig <[email protected]>
 *
 *  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 version 2
 *
 *  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.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with this program; if not, write to the Free Software
 *  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
 */

#include <linux/kernel.h>
#include <linux/slab.h>
#include <linux/usb.h>

#include "tm6000.h"
#include "tm6000-regs.h"

#include "zl10353.h"

#include <media/tuner.h>

#include "tuner-xc2028.h"
#include "xc5000.h"

MODULE_DESCRIPTION("DVB driver extension module for tm5600/6000/6010 based TV cards");
MODULE_AUTHOR("Mauro Carvalho Chehab <[email protected]>");
MODULE_LICENSE("GPL");

MODULE_SUPPORTED_DEVICE("{{Trident, tm5600},"
            "{{Trident, tm6000},"
            "{{Trident, tm6010}");

static int debug;

module_param(debug, int, 0644);
MODULE_PARM_DESC(debug, "enable debug message");

static inline void print_err_status(struct tm6000_core *dev,
                    int packet, int status)
{
    char *errmsg = "Unknown";

    switch (status) {
    case -ENOENT:
        errmsg = "unlinked synchronuously";
        break;
    case -ECONNRESET:
        errmsg = "unlinked asynchronuously";
        break;
    case -ENOSR:
        errmsg = "Buffer error (overrun)";
        break;
    case -EPIPE:
        errmsg = "Stalled (device not responding)";
        break;
    case -EOVERFLOW:
        errmsg = "Babble (bad cable?)";
        break;
    case -EPROTO:
        errmsg = "Bit-stuff error (bad cable?)";
        break;
    case -EILSEQ:
        errmsg = "CRC/Timeout (could be anything)";
        break;
    case -ETIME:
        errmsg = "Device does not respond";
        break;
    }
    if (packet < 0) {
        dprintk(dev, 1, "URB status %d [%s].\n",
            status, errmsg);
    } else {
        dprintk(dev, 1, "URB packet %d, status %d [%s].\n",
            packet, status, errmsg);
    }
}

static void tm6000_urb_received(struct urb *urb)
{
    int ret;
    struct tm6000_core *dev = urb->context;

    switch (urb->status) {
    case 0:
    case -ETIMEDOUT:
        break;
    case -ENOENT:
    case -ECONNRESET:
    case -ESHUTDOWN:
        return;
    default:
        print_err_status(dev, 0, urb->status);
    }

    if (urb->actual_length > 0)
        dvb_dmx_swfilter(&dev->dvb->demux, urb->transfer_buffer,
                           urb->actual_length);

    if (dev->dvb->streams > 0) {
        ret = usb_submit_urb(urb, GFP_ATOMIC);
        if (ret < 0) {
            printk(KERN_ERR "tm6000:  error %s\n", __func__);
            kfree(urb->transfer_buffer);
            usb_free_urb(urb);
        }
    }
}

static int tm6000_start_stream(struct tm6000_core *dev)
{
    int ret;
    unsigned int pipe, size;
    struct tm6000_dvb *dvb = dev->dvb;

    printk(KERN_INFO "tm6000: got start stream request %s\n", __func__);

    if (dev->mode != TM6000_MODE_DIGITAL) {
        tm6000_init_digital_mode(dev);
        dev->mode = TM6000_MODE_DIGITAL;
    }

    dvb->bulk_urb = usb_alloc_urb(0, GFP_KERNEL);
    if (dvb->bulk_urb == NULL) {
        printk(KERN_ERR "tm6000: couldn't allocate urb\n");
        return -ENOMEM;
    }

    pipe = usb_rcvbulkpipe(dev->udev, dev->bulk_in.endp->desc.bEndpointAddress
                              & USB_ENDPOINT_NUMBER_MASK);

    size = usb_maxpacket(dev->udev, pipe, usb_pipeout(pipe));
    size = size * 15; /* 512 x 8 or 12 or 15 */

    dvb->bulk_urb->transfer_buffer = kzalloc(size, GFP_KERNEL);
    if (dvb->bulk_urb->transfer_buffer == NULL) {
        usb_free_urb(dvb->bulk_urb);
        printk(KERN_ERR "tm6000: couldn't allocate transfer buffer!\n");
        return -ENOMEM;
    }

    usb_fill_bulk_urb(dvb->bulk_urb, dev->udev, pipe,
                         dvb->bulk_urb->transfer_buffer,
                         size,
                         tm6000_urb_received, dev);

    ret = usb_clear_halt(dev->udev, pipe);
    if (ret < 0) {
        printk(KERN_ERR "tm6000: error %i in %s during pipe reset\n",
                            ret, __func__);
        return ret;
    } else
        printk(KERN_ERR "tm6000: pipe resetted\n");

/*  mutex_lock(&tm6000_driver.open_close_mutex); */
    ret = usb_submit_urb(dvb->bulk_urb, GFP_ATOMIC);

/*  mutex_unlock(&tm6000_driver.open_close_mutex); */
    if (ret) {
        printk(KERN_ERR "tm6000: submit of urb failed (error=%i)\n",
                                    ret);

        kfree(dvb->bulk_urb->transfer_buffer);
        usb_free_urb(dvb->bulk_urb);
        return ret;
    }

    return 0;
}

static void tm6000_stop_stream(struct tm6000_core *dev)
{
    struct tm6000_dvb *dvb = dev->dvb;

    if (dvb->bulk_urb) {
        printk(KERN_INFO "urb killing\n");
        usb_kill_urb(dvb->bulk_urb);
        printk(KERN_INFO "urb buffer free\n");
        kfree(dvb->bulk_urb->transfer_buffer);
        usb_free_urb(dvb->bulk_urb);
        dvb->bulk_urb = NULL;
    }
}

static int tm6000_start_feed(struct dvb_demux_feed *feed)
{
    struct dvb_demux *demux = feed->demux;
    struct tm6000_core *dev = demux->priv;
    struct tm6000_dvb *dvb = dev->dvb;
    printk(KERN_INFO "tm6000: got start feed request %s\n", __func__);

    mutex_lock(&dvb->mutex);
    if (dvb->streams == 0) {
        dvb->streams = 1;
/*      mutex_init(&tm6000_dev->streming_mutex); */
        tm6000_start_stream(dev);
    } else
        ++(dvb->streams);
    mutex_unlock(&dvb->mutex);

    return 0;
}

static int tm6000_stop_feed(struct dvb_demux_feed *feed)
{
    struct dvb_demux *demux = feed->demux;
    struct tm6000_core *dev = demux->priv;
    struct tm6000_dvb *dvb = dev->dvb;

    printk(KERN_INFO "tm6000: got stop feed request %s\n", __func__);

    mutex_lock(&dvb->mutex);

    printk(KERN_INFO "stream %#x\n", dvb->streams);
    --(dvb->streams);
    if (dvb->streams == 0) {
        printk(KERN_INFO "stop stream\n");
        tm6000_stop_stream(dev);
/*      mutex_destroy(&tm6000_dev->streaming_mutex); */
    }
    mutex_unlock(&dvb->mutex);
/*  mutex_destroy(&tm6000_dev->streaming_mutex); */

    return 0;
}

static int tm6000_dvb_attach_frontend(struct tm6000_core *dev)
{
    struct tm6000_dvb *dvb = dev->dvb;

    if (dev->caps.has_zl10353) {
        struct zl10353_config config = {
                     .demod_address = dev->demod_addr,
                     .no_tuner = 1,
                     .parallel_ts = 1,
                     .if2 = 45700,
                     .disable_i2c_gate_ctrl = 1,
                    };

        dvb->frontend = dvb_attach(zl10353_attach, &config,
                               &dev->i2c_adap);
    } else {
        printk(KERN_ERR "tm6000: no frontend defined for the device!\n");
        return -1;
    }

    return (!dvb->frontend) ? -1 : 0;
}

DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);

static int register_dvb(struct tm6000_core *dev)
{
    int ret = -1;
    struct tm6000_dvb *dvb = dev->dvb;

    mutex_init(&dvb->mutex);

    dvb->streams = 0;

    /* attach the frontend */
    ret = tm6000_dvb_attach_frontend(dev);
    if (ret < 0) {
        printk(KERN_ERR "tm6000: couldn't attach the frontend!\n");
        goto err;
    }

    ret = dvb_register_adapter(&dvb->adapter, "Trident TVMaster 6000 DVB-T",
                    THIS_MODULE, &dev->udev->dev, adapter_nr);
    dvb->adapter.priv = dev;

    if (dvb->frontend) {
        switch (dev->tuner_type) {
        case TUNER_XC2028: {
            struct xc2028_config cfg = {
                .i2c_adap = &dev->i2c_adap,
                .i2c_addr = dev->tuner_addr,
            };

            dvb->frontend->callback = tm6000_tuner_callback;
            ret = dvb_register_frontend(&dvb->adapter, dvb->frontend);
            if (ret < 0) {
                printk(KERN_ERR
                    "tm6000: couldn't register frontend\n");
                goto adapter_err;
            }

            if (!dvb_attach(xc2028_attach, dvb->frontend, &cfg)) {
                printk(KERN_ERR "tm6000: couldn't register "
                        "frontend (xc3028)\n");
                ret = -EINVAL;
                goto frontend_err;
            }
            printk(KERN_INFO "tm6000: XC2028/3028 asked to be "
                     "attached to frontend!\n");
            break;
            }
        case TUNER_XC5000: {
            struct xc5000_config cfg = {
                .i2c_address = dev->tuner_addr,
            };

            dvb->frontend->callback = tm6000_xc5000_callback;
            ret = dvb_register_frontend(&dvb->adapter, dvb->frontend);
            if (ret < 0) {
                printk(KERN_ERR
                    "tm6000: couldn't register frontend\n");
                goto adapter_err;
            }

            if (!dvb_attach(xc5000_attach, dvb->frontend, &dev->i2c_adap, &cfg)) {
                printk(KERN_ERR "tm6000: couldn't register "
                        "frontend (xc5000)\n");
                ret = -EINVAL;
                goto frontend_err;
            }
            printk(KERN_INFO "tm6000: XC5000 asked to be "
                     "attached to frontend!\n");
            break;
            }
        }
    } else
        printk(KERN_ERR "tm6000: no frontend found\n");

    dvb->demux.dmx.capabilities = DMX_TS_FILTERING | DMX_SECTION_FILTERING
                                | DMX_MEMORY_BASED_FILTERING;
    dvb->demux.priv = dev;
    dvb->demux.filternum = 8;
    dvb->demux.feednum = 8;
    dvb->demux.start_feed = tm6000_start_feed;
    dvb->demux.stop_feed = tm6000_stop_feed;
    dvb->demux.write_to_decoder = NULL;
    ret = dvb_dmx_init(&dvb->demux);
    if (ret < 0) {
        printk(KERN_ERR "tm6000: dvb_dmx_init failed (errno = %d)\n", ret);
        goto frontend_err;
    }

    dvb->dmxdev.filternum = dev->dvb->demux.filternum;
    dvb->dmxdev.demux = &dev->dvb->demux.dmx;
    dvb->dmxdev.capabilities = 0;

    ret =  dvb_dmxdev_init(&dvb->dmxdev, &dvb->adapter);
    if (ret < 0) {
        printk(KERN_ERR "tm6000: dvb_dmxdev_init failed (errno = %d)\n", ret);
        goto dvb_dmx_err;
    }

    return 0;

dvb_dmx_err:
    dvb_dmx_release(&dvb->demux);
frontend_err:
    if (dvb->frontend) {
        dvb_frontend_detach(dvb->frontend);
        dvb_unregister_frontend(dvb->frontend);
    }
adapter_err:
    dvb_unregister_adapter(&dvb->adapter);
err:
    return ret;
}

static void unregister_dvb(struct tm6000_core *dev)
{
    struct tm6000_dvb *dvb = dev->dvb;

    if (dvb->bulk_urb != NULL) {
        struct urb *bulk_urb = dvb->bulk_urb;

        kfree(bulk_urb->transfer_buffer);
        bulk_urb->transfer_buffer = NULL;
        usb_unlink_urb(bulk_urb);
        usb_free_urb(bulk_urb);
    }

/*  mutex_lock(&tm6000_driver.open_close_mutex); */
    if (dvb->frontend) {
        dvb_frontend_detach(dvb->frontend);
        dvb_unregister_frontend(dvb->frontend);
    }

    dvb_dmxdev_release(&dvb->dmxdev);
    dvb_dmx_release(&dvb->demux);
    dvb_unregister_adapter(&dvb->adapter);
    mutex_destroy(&dvb->mutex);
/*  mutex_unlock(&tm6000_driver.open_close_mutex); */
}

static int dvb_init(struct tm6000_core *dev)
{
    struct tm6000_dvb *dvb;
    int rc;

    if (!dev)
        return 0;

    if (!dev->caps.has_dvb)
        return 0;

    if (dev->udev->speed == USB_SPEED_FULL) {
        printk(KERN_INFO "This USB2.0 device cannot be run on a USB1.1 port. (it lacks a hardware PID filter)\n");
        return 0;
    }

    dvb = kzalloc(sizeof(struct tm6000_dvb), GFP_KERNEL);
    if (!dvb) {
        printk(KERN_INFO "Cannot allocate memory\n");
        return -ENOMEM;
    }

    dev->dvb = dvb;

    rc = register_dvb(dev);
    if (rc < 0) {
        kfree(dvb);
        dev->dvb = NULL;
        return 0;
    }

    return 0;
}

static int dvb_fini(struct tm6000_core *dev)
{
    if (!dev)
        return 0;

    if (!dev->caps.has_dvb)
        return 0;

    if (dev->dvb) {
        unregister_dvb(dev);
        kfree(dev->dvb);
        dev->dvb = NULL;
    }

    return 0;
}

static struct tm6000_ops dvb_ops = {
    .type   = TM6000_DVB,
    .name   = "TM6000 dvb Extension",
    .init   = dvb_init,
    .fini   = dvb_fini,
};

static int __init tm6000_dvb_register(void)
{
    return tm6000_register_extension(&dvb_ops);
}

static void __exit tm6000_dvb_unregister(void)
{
    tm6000_unregister_extension(&dvb_ops);
}

module_init(tm6000_dvb_register);
module_exit(tm6000_dvb_unregister);