mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-12-02 16:44:10 +08:00
fe78a49c8a
A regression was introduced in hg changeset 33810c734a0d, which resulted in a kernel panic whenever the device was disconnected from USB. The call to 4l2_device_register() was overwriting the pointer for usb_set_intfdata(), so when au0828_usb_disconnect() was called, the usb_get_intfdata() returned a pointer to the v4l2_device instead of the au0828_dev structure. Signed-off-by: Devin Heitmueller <dheitmueller@linuxtv.org> Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>
277 lines
6.8 KiB
C
277 lines
6.8 KiB
C
/*
|
|
* Driver for the Auvitek USB bridge
|
|
*
|
|
* Copyright (c) 2008 Steven Toth <stoth@linuxtv.org>
|
|
*
|
|
* 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., 675 Mass Ave, Cambridge, MA 02139, USA.
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/videodev2.h>
|
|
#include <media/v4l2-common.h>
|
|
#include <linux/mutex.h>
|
|
|
|
#include "au0828.h"
|
|
|
|
/*
|
|
* 1 = General debug messages
|
|
* 2 = USB handling
|
|
* 4 = I2C related
|
|
* 8 = Bridge related
|
|
*/
|
|
int au0828_debug;
|
|
module_param_named(debug, au0828_debug, int, 0644);
|
|
MODULE_PARM_DESC(debug, "enable debug messages");
|
|
|
|
#define _AU0828_BULKPIPE 0x03
|
|
#define _BULKPIPESIZE 0xffff
|
|
|
|
static int send_control_msg(struct au0828_dev *dev, u16 request, u32 value,
|
|
u16 index, unsigned char *cp, u16 size);
|
|
static int recv_control_msg(struct au0828_dev *dev, u16 request, u32 value,
|
|
u16 index, unsigned char *cp, u16 size);
|
|
|
|
/* USB Direction */
|
|
#define CMD_REQUEST_IN 0x00
|
|
#define CMD_REQUEST_OUT 0x01
|
|
|
|
u32 au0828_readreg(struct au0828_dev *dev, u16 reg)
|
|
{
|
|
recv_control_msg(dev, CMD_REQUEST_IN, 0, reg, dev->ctrlmsg, 1);
|
|
dprintk(8, "%s(0x%04x) = 0x%02x\n", __func__, reg, dev->ctrlmsg[0]);
|
|
return dev->ctrlmsg[0];
|
|
}
|
|
|
|
u32 au0828_writereg(struct au0828_dev *dev, u16 reg, u32 val)
|
|
{
|
|
dprintk(8, "%s(0x%04x, 0x%02x)\n", __func__, reg, val);
|
|
return send_control_msg(dev, CMD_REQUEST_OUT, val, reg,
|
|
dev->ctrlmsg, 0);
|
|
}
|
|
|
|
static void cmd_msg_dump(struct au0828_dev *dev)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < sizeof(dev->ctrlmsg); i += 16)
|
|
dprintk(2, "%s() %02x %02x %02x %02x %02x %02x %02x %02x "
|
|
"%02x %02x %02x %02x %02x %02x %02x %02x\n",
|
|
__func__,
|
|
dev->ctrlmsg[i+0], dev->ctrlmsg[i+1],
|
|
dev->ctrlmsg[i+2], dev->ctrlmsg[i+3],
|
|
dev->ctrlmsg[i+4], dev->ctrlmsg[i+5],
|
|
dev->ctrlmsg[i+6], dev->ctrlmsg[i+7],
|
|
dev->ctrlmsg[i+8], dev->ctrlmsg[i+9],
|
|
dev->ctrlmsg[i+10], dev->ctrlmsg[i+11],
|
|
dev->ctrlmsg[i+12], dev->ctrlmsg[i+13],
|
|
dev->ctrlmsg[i+14], dev->ctrlmsg[i+15]);
|
|
}
|
|
|
|
static int send_control_msg(struct au0828_dev *dev, u16 request, u32 value,
|
|
u16 index, unsigned char *cp, u16 size)
|
|
{
|
|
int status = -ENODEV;
|
|
mutex_lock(&dev->mutex);
|
|
if (dev->usbdev) {
|
|
|
|
/* cp must be memory that has been allocated by kmalloc */
|
|
status = usb_control_msg(dev->usbdev,
|
|
usb_sndctrlpipe(dev->usbdev, 0),
|
|
request,
|
|
USB_DIR_OUT | USB_TYPE_VENDOR |
|
|
USB_RECIP_DEVICE,
|
|
value, index,
|
|
cp, size, 1000);
|
|
|
|
status = min(status, 0);
|
|
|
|
if (status < 0) {
|
|
printk(KERN_ERR "%s() Failed sending control message, error %d.\n",
|
|
__func__, status);
|
|
}
|
|
|
|
}
|
|
mutex_unlock(&dev->mutex);
|
|
return status;
|
|
}
|
|
|
|
static int recv_control_msg(struct au0828_dev *dev, u16 request, u32 value,
|
|
u16 index, unsigned char *cp, u16 size)
|
|
{
|
|
int status = -ENODEV;
|
|
mutex_lock(&dev->mutex);
|
|
if (dev->usbdev) {
|
|
|
|
memset(dev->ctrlmsg, 0, sizeof(dev->ctrlmsg));
|
|
|
|
/* cp must be memory that has been allocated by kmalloc */
|
|
status = usb_control_msg(dev->usbdev,
|
|
usb_rcvctrlpipe(dev->usbdev, 0),
|
|
request,
|
|
USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
|
|
value, index,
|
|
cp, size, 1000);
|
|
|
|
status = min(status, 0);
|
|
|
|
if (status < 0) {
|
|
printk(KERN_ERR "%s() Failed receiving control message, error %d.\n",
|
|
__func__, status);
|
|
} else
|
|
cmd_msg_dump(dev);
|
|
}
|
|
mutex_unlock(&dev->mutex);
|
|
return status;
|
|
}
|
|
|
|
static void au0828_usb_disconnect(struct usb_interface *interface)
|
|
{
|
|
struct au0828_dev *dev = usb_get_intfdata(interface);
|
|
|
|
dprintk(1, "%s()\n", __func__);
|
|
|
|
/* Digital TV */
|
|
au0828_dvb_unregister(dev);
|
|
|
|
if (AUVI_INPUT(0).type != AU0828_VMUX_UNDEFINED)
|
|
au0828_analog_unregister(dev);
|
|
|
|
/* I2C */
|
|
au0828_i2c_unregister(dev);
|
|
|
|
v4l2_device_unregister(&dev->v4l2_dev);
|
|
|
|
usb_set_intfdata(interface, NULL);
|
|
|
|
mutex_lock(&dev->mutex);
|
|
dev->usbdev = NULL;
|
|
mutex_unlock(&dev->mutex);
|
|
|
|
kfree(dev);
|
|
|
|
}
|
|
|
|
static int au0828_usb_probe(struct usb_interface *interface,
|
|
const struct usb_device_id *id)
|
|
{
|
|
int ifnum, retval;
|
|
struct au0828_dev *dev;
|
|
struct usb_device *usbdev = interface_to_usbdev(interface);
|
|
|
|
ifnum = interface->altsetting->desc.bInterfaceNumber;
|
|
|
|
if (ifnum != 0)
|
|
return -ENODEV;
|
|
|
|
dprintk(1, "%s() vendor id 0x%x device id 0x%x ifnum:%d\n", __func__,
|
|
le16_to_cpu(usbdev->descriptor.idVendor),
|
|
le16_to_cpu(usbdev->descriptor.idProduct),
|
|
ifnum);
|
|
|
|
dev = kzalloc(sizeof(*dev), GFP_KERNEL);
|
|
if (dev == NULL) {
|
|
printk(KERN_ERR "%s() Unable to allocate memory\n", __func__);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
mutex_init(&dev->mutex);
|
|
mutex_init(&dev->dvb.lock);
|
|
dev->usbdev = usbdev;
|
|
dev->boardnr = id->driver_info;
|
|
|
|
/* Create the v4l2_device */
|
|
retval = v4l2_device_register(&interface->dev, &dev->v4l2_dev);
|
|
if (retval) {
|
|
printk(KERN_ERR "%s() v4l2_device_register failed\n",
|
|
__func__);
|
|
kfree(dev);
|
|
return -EIO;
|
|
}
|
|
|
|
/* Power Up the bridge */
|
|
au0828_write(dev, REG_600, 1 << 4);
|
|
|
|
/* Bring up the GPIO's and supporting devices */
|
|
au0828_gpio_setup(dev);
|
|
|
|
/* I2C */
|
|
au0828_i2c_register(dev);
|
|
|
|
/* Setup */
|
|
au0828_card_setup(dev);
|
|
|
|
/* Analog TV */
|
|
if (AUVI_INPUT(0).type != AU0828_VMUX_UNDEFINED)
|
|
au0828_analog_register(dev, interface);
|
|
|
|
/* Digital TV */
|
|
au0828_dvb_register(dev);
|
|
|
|
/* Store the pointer to the au0828_dev so it can be accessed in
|
|
au0828_usb_disconnect */
|
|
usb_set_intfdata(interface, dev);
|
|
|
|
printk(KERN_INFO "Registered device AU0828 [%s]\n",
|
|
dev->board.name == NULL ? "Unset" : dev->board.name);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct usb_driver au0828_usb_driver = {
|
|
.name = DRIVER_NAME,
|
|
.probe = au0828_usb_probe,
|
|
.disconnect = au0828_usb_disconnect,
|
|
.id_table = au0828_usb_id_table,
|
|
};
|
|
|
|
static int __init au0828_init(void)
|
|
{
|
|
int ret;
|
|
|
|
if (au0828_debug & 1)
|
|
printk(KERN_INFO "%s() Debugging is enabled\n", __func__);
|
|
|
|
if (au0828_debug & 2)
|
|
printk(KERN_INFO "%s() USB Debugging is enabled\n", __func__);
|
|
|
|
if (au0828_debug & 4)
|
|
printk(KERN_INFO "%s() I2C Debugging is enabled\n", __func__);
|
|
|
|
if (au0828_debug & 8)
|
|
printk(KERN_INFO "%s() Bridge Debugging is enabled\n",
|
|
__func__);
|
|
|
|
printk(KERN_INFO "au0828 driver loaded\n");
|
|
|
|
ret = usb_register(&au0828_usb_driver);
|
|
if (ret)
|
|
printk(KERN_ERR "usb_register failed, error = %d\n", ret);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static void __exit au0828_exit(void)
|
|
{
|
|
usb_deregister(&au0828_usb_driver);
|
|
}
|
|
|
|
module_init(au0828_init);
|
|
module_exit(au0828_exit);
|
|
|
|
MODULE_DESCRIPTION("Driver for Auvitek AU0828 based products");
|
|
MODULE_AUTHOR("Steven Toth <stoth@linuxtv.org>");
|
|
MODULE_LICENSE("GPL");
|