dsbr100.c

Go to the documentation of this file.

/* A driver for the D-Link DSB-R100 USB radio and Gemtek USB Radio 21.
 * The device plugs into both the USB and an analog audio input, so this thing
 * only deals with initialisation and frequency setting, the
 * audio data has to be handled by a sound driver.
 *
 * Major issue: I can't find out where the device reports the signal
 * strength, and indeed the windows software appearantly just looks
 * at the stereo indicator as well.  So, scanning will only find
 * stereo stations.  Sad, but I can't help it.
 *
 * Also, the windows program sends oodles of messages over to the
 * device, and I couldn't figure out their meaning.  My suspicion
 * is that they don't have any:-)
 *
 * You might find some interesting stuff about this module at
 * http://unimut.fsk.uni-heidelberg.de/unimut/demi/dsbr
 *
 * Fully tested with the Keene USB FM Transmitter and the v4l2-compliance tool.
 *
 * Copyright (c) 2000 Markus Demleitner <[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; either version 2 of the License, 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.
 *
 * 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., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
*/

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/slab.h>
#include <linux/input.h>
#include <linux/videodev2.h>
#include <linux/usb.h>
#include <media/v4l2-device.h>
#include <media/v4l2-ioctl.h>
#include <media/v4l2-ctrls.h>
#include <media/v4l2-event.h>

/*
 * Version Information
 */
MODULE_AUTHOR("Markus Demleitner <[email protected]>");
MODULE_DESCRIPTION("D-Link DSB-R100 USB FM radio driver");
MODULE_LICENSE("GPL");
MODULE_VERSION("1.1.0");

#define DSB100_VENDOR 0x04b4
#define DSB100_PRODUCT 0x1002

/* Commands the device appears to understand */
#define DSB100_TUNE 1
#define DSB100_ONOFF 2

#define TB_LEN 16

/* Frequency limits in MHz -- these are European values.  For Japanese
devices, that would be 76 and 91.  */
#define FREQ_MIN  87.5
#define FREQ_MAX 108.0
#define FREQ_MUL 16000

#define v4l2_dev_to_radio(d) container_of(d, struct dsbr100_device, v4l2_dev)

static int radio_nr = -1;
module_param(radio_nr, int, 0);

/* Data for one (physical) device */
struct dsbr100_device {
    struct usb_device *usbdev;
    struct video_device videodev;
    struct v4l2_device v4l2_dev;
    struct v4l2_ctrl_handler hdl;

    u8 *transfer_buffer;
    struct mutex v4l2_lock;
    int curfreq;
    bool stereo;
    bool muted;
};

/* Low-level device interface begins here */

/* set a frequency, freq is defined by v4l's TUNER_LOW, i.e. 1/16th kHz */
static int dsbr100_setfreq(struct dsbr100_device *radio, unsigned freq)
{
    unsigned f = (freq / 16 * 80) / 1000 + 856;
    int retval = 0;

    if (!radio->muted) {
        retval = usb_control_msg(radio->usbdev,
                usb_rcvctrlpipe(radio->usbdev, 0),
                DSB100_TUNE,
                USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN,
                (f >> 8) & 0x00ff, f & 0xff,
                radio->transfer_buffer, 8, 300);
        if (retval >= 0)
            mdelay(1);
    }

    if (retval >= 0) {
        radio->curfreq = freq;
        return 0;
    }
    dev_err(&radio->usbdev->dev,
        "%s - usb_control_msg returned %i, request %i\n",
            __func__, retval, DSB100_TUNE);
    return retval;
}

/* switch on radio */
static int dsbr100_start(struct dsbr100_device *radio)
{
    int retval = usb_control_msg(radio->usbdev,
        usb_rcvctrlpipe(radio->usbdev, 0),
        DSB100_ONOFF,
        USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN,
        0x01, 0x00, radio->transfer_buffer, 8, 300);

    if (retval >= 0)
        return dsbr100_setfreq(radio, radio->curfreq);
    dev_err(&radio->usbdev->dev,
        "%s - usb_control_msg returned %i, request %i\n",
            __func__, retval, DSB100_ONOFF);
    return retval;

}

/* switch off radio */
static int dsbr100_stop(struct dsbr100_device *radio)
{
    int retval = usb_control_msg(radio->usbdev,
        usb_rcvctrlpipe(radio->usbdev, 0),
        DSB100_ONOFF,
        USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN,
        0x00, 0x00, radio->transfer_buffer, 8, 300);

    if (retval >= 0)
        return 0;
    dev_err(&radio->usbdev->dev,
        "%s - usb_control_msg returned %i, request %i\n",
            __func__, retval, DSB100_ONOFF);
    return retval;

}

/* return the device status.  This is, in effect, just whether it
sees a stereo signal or not.  Pity. */
static void dsbr100_getstat(struct dsbr100_device *radio)
{
    int retval = usb_control_msg(radio->usbdev,
        usb_rcvctrlpipe(radio->usbdev, 0),
        USB_REQ_GET_STATUS,
        USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN,
        0x00, 0x24, radio->transfer_buffer, 8, 300);

    if (retval < 0) {
        radio->stereo = false;
        dev_err(&radio->usbdev->dev,
            "%s - usb_control_msg returned %i, request %i\n",
                __func__, retval, USB_REQ_GET_STATUS);
    } else {
        radio->stereo = !(radio->transfer_buffer[0] & 0x01);
    }
}

static int vidioc_querycap(struct file *file, void *priv,
                    struct v4l2_capability *v)
{
    struct dsbr100_device *radio = video_drvdata(file);

    strlcpy(v->driver, "dsbr100", sizeof(v->driver));
    strlcpy(v->card, "D-Link R-100 USB FM Radio", sizeof(v->card));
    usb_make_path(radio->usbdev, v->bus_info, sizeof(v->bus_info));
    v->device_caps = V4L2_CAP_RADIO | V4L2_CAP_TUNER;
    v->capabilities = v->device_caps | V4L2_CAP_DEVICE_CAPS;
    return 0;
}

static int vidioc_g_tuner(struct file *file, void *priv,
                struct v4l2_tuner *v)
{
    struct dsbr100_device *radio = video_drvdata(file);

    if (v->index > 0)
        return -EINVAL;

    dsbr100_getstat(radio);
    strcpy(v->name, "FM");
    v->type = V4L2_TUNER_RADIO;
    v->rangelow = FREQ_MIN * FREQ_MUL;
    v->rangehigh = FREQ_MAX * FREQ_MUL;
    v->rxsubchans = radio->stereo ? V4L2_TUNER_SUB_STEREO :
        V4L2_TUNER_SUB_MONO;
    v->capability = V4L2_TUNER_CAP_LOW | V4L2_TUNER_CAP_STEREO;
    v->audmode = V4L2_TUNER_MODE_STEREO;
    v->signal = radio->stereo ? 0xffff : 0;     /* We can't get the signal strength */
    return 0;
}

static int vidioc_s_tuner(struct file *file, void *priv,
                struct v4l2_tuner *v)
{
    return v->index ? -EINVAL : 0;
}

static int vidioc_s_frequency(struct file *file, void *priv,
                struct v4l2_frequency *f)
{
    struct dsbr100_device *radio = video_drvdata(file);

    if (f->tuner != 0 || f->type != V4L2_TUNER_RADIO)
        return -EINVAL;

    return dsbr100_setfreq(radio, clamp_t(unsigned, f->frequency,
            FREQ_MIN * FREQ_MUL, FREQ_MAX * FREQ_MUL));
}

static int vidioc_g_frequency(struct file *file, void *priv,
                struct v4l2_frequency *f)
{
    struct dsbr100_device *radio = video_drvdata(file);

    if (f->tuner)
        return -EINVAL;
    f->type = V4L2_TUNER_RADIO;
    f->frequency = radio->curfreq;
    return 0;
}

static int usb_dsbr100_s_ctrl(struct v4l2_ctrl *ctrl)
{
    struct dsbr100_device *radio =
        container_of(ctrl->handler, struct dsbr100_device, hdl);

    switch (ctrl->id) {
    case V4L2_CID_AUDIO_MUTE:
        radio->muted = ctrl->val;
        return radio->muted ? dsbr100_stop(radio) : dsbr100_start(radio);
    }
    return -EINVAL;
}


/* USB subsystem interface begins here */

/*
 * Handle unplugging of the device.
 * We call video_unregister_device in any case.
 * The last function called in this procedure is
 * usb_dsbr100_video_device_release
 */
static void usb_dsbr100_disconnect(struct usb_interface *intf)
{
    struct dsbr100_device *radio = usb_get_intfdata(intf);

    mutex_lock(&radio->v4l2_lock);
    /*
     * Disconnect is also called on unload, and in that case we need to
     * mute the device. This call will silently fail if it is called
     * after a physical disconnect.
     */
    usb_control_msg(radio->usbdev,
        usb_rcvctrlpipe(radio->usbdev, 0),
        DSB100_ONOFF,
        USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN,
        0x00, 0x00, radio->transfer_buffer, 8, 300);
    usb_set_intfdata(intf, NULL);
    video_unregister_device(&radio->videodev);
    v4l2_device_disconnect(&radio->v4l2_dev);
    mutex_unlock(&radio->v4l2_lock);
    v4l2_device_put(&radio->v4l2_dev);
}


/* Suspend device - stop device. */
static int usb_dsbr100_suspend(struct usb_interface *intf, pm_message_t message)
{
    struct dsbr100_device *radio = usb_get_intfdata(intf);

    mutex_lock(&radio->v4l2_lock);
    if (!radio->muted && dsbr100_stop(radio) < 0)
        dev_warn(&intf->dev, "dsbr100_stop failed\n");
    mutex_unlock(&radio->v4l2_lock);

    dev_info(&intf->dev, "going into suspend..\n");
    return 0;
}

/* Resume device - start device. */
static int usb_dsbr100_resume(struct usb_interface *intf)
{
    struct dsbr100_device *radio = usb_get_intfdata(intf);

    mutex_lock(&radio->v4l2_lock);
    if (!radio->muted && dsbr100_start(radio) < 0)
        dev_warn(&intf->dev, "dsbr100_start failed\n");
    mutex_unlock(&radio->v4l2_lock);

    dev_info(&intf->dev, "coming out of suspend..\n");
    return 0;
}

/* free data structures */
static void usb_dsbr100_release(struct v4l2_device *v4l2_dev)
{
    struct dsbr100_device *radio = v4l2_dev_to_radio(v4l2_dev);

    v4l2_ctrl_handler_free(&radio->hdl);
    v4l2_device_unregister(&radio->v4l2_dev);
    kfree(radio->transfer_buffer);
    kfree(radio);
}

static const struct v4l2_ctrl_ops usb_dsbr100_ctrl_ops = {
    .s_ctrl = usb_dsbr100_s_ctrl,
};

/* File system interface */
static const struct v4l2_file_operations usb_dsbr100_fops = {
    .owner      = THIS_MODULE,
    .unlocked_ioctl = video_ioctl2,
    .open           = v4l2_fh_open,
    .release        = v4l2_fh_release,
    .poll       = v4l2_ctrl_poll,
};

static const struct v4l2_ioctl_ops usb_dsbr100_ioctl_ops = {
    .vidioc_querycap    = vidioc_querycap,
    .vidioc_g_tuner     = vidioc_g_tuner,
    .vidioc_s_tuner     = vidioc_s_tuner,
    .vidioc_g_frequency = vidioc_g_frequency,
    .vidioc_s_frequency = vidioc_s_frequency,
    .vidioc_log_status  = v4l2_ctrl_log_status,
    .vidioc_subscribe_event = v4l2_ctrl_subscribe_event,
    .vidioc_unsubscribe_event = v4l2_event_unsubscribe,
};

/* check if the device is present and register with v4l and usb if it is */
static int usb_dsbr100_probe(struct usb_interface *intf,
                const struct usb_device_id *id)
{
    struct dsbr100_device *radio;
    struct v4l2_device *v4l2_dev;
    int retval;

    radio = kzalloc(sizeof(struct dsbr100_device), GFP_KERNEL);

    if (!radio)
        return -ENOMEM;

    radio->transfer_buffer = kmalloc(TB_LEN, GFP_KERNEL);

    if (!(radio->transfer_buffer)) {
        kfree(radio);
        return -ENOMEM;
    }

    v4l2_dev = &radio->v4l2_dev;
    v4l2_dev->release = usb_dsbr100_release;

    retval = v4l2_device_register(&intf->dev, v4l2_dev);
    if (retval < 0) {
        v4l2_err(v4l2_dev, "couldn't register v4l2_device\n");
        goto err_reg_dev;
    }

    v4l2_ctrl_handler_init(&radio->hdl, 1);
    v4l2_ctrl_new_std(&radio->hdl, &usb_dsbr100_ctrl_ops,
              V4L2_CID_AUDIO_MUTE, 0, 1, 1, 1);
    if (radio->hdl.error) {
        retval = radio->hdl.error;
        v4l2_err(v4l2_dev, "couldn't register control\n");
        goto err_reg_ctrl;
    }
    mutex_init(&radio->v4l2_lock);
    strlcpy(radio->videodev.name, v4l2_dev->name, sizeof(radio->videodev.name));
    radio->videodev.v4l2_dev = v4l2_dev;
    radio->videodev.fops = &usb_dsbr100_fops;
    radio->videodev.ioctl_ops = &usb_dsbr100_ioctl_ops;
    radio->videodev.release = video_device_release_empty;
    radio->videodev.lock = &radio->v4l2_lock;
    radio->videodev.ctrl_handler = &radio->hdl;
    set_bit(V4L2_FL_USE_FH_PRIO, &radio->videodev.flags);

    radio->usbdev = interface_to_usbdev(intf);
    radio->curfreq = FREQ_MIN * FREQ_MUL;
    radio->muted = true;

    video_set_drvdata(&radio->videodev, radio);
    usb_set_intfdata(intf, radio);

    retval = video_register_device(&radio->videodev, VFL_TYPE_RADIO, radio_nr);
    if (retval == 0)
        return 0;
    v4l2_err(v4l2_dev, "couldn't register video device\n");

err_reg_ctrl:
    v4l2_ctrl_handler_free(&radio->hdl);
    v4l2_device_unregister(v4l2_dev);
err_reg_dev:
    kfree(radio->transfer_buffer);
    kfree(radio);
    return retval;
}

static struct usb_device_id usb_dsbr100_device_table[] = {
    { USB_DEVICE(DSB100_VENDOR, DSB100_PRODUCT) },
    { }                     /* Terminating entry */
};

MODULE_DEVICE_TABLE(usb, usb_dsbr100_device_table);

/* USB subsystem interface */
static struct usb_driver usb_dsbr100_driver = {
    .name           = "dsbr100",
    .probe          = usb_dsbr100_probe,
    .disconnect     = usb_dsbr100_disconnect,
    .id_table       = usb_dsbr100_device_table,
    .suspend        = usb_dsbr100_suspend,
    .resume         = usb_dsbr100_resume,
    .reset_resume       = usb_dsbr100_resume,
};

module_usb_driver(usb_dsbr100_driver);