Commit 417b7953 authored by Alexey Klimov's avatar Alexey Klimov Committed by Mauro Carvalho Chehab

V4L/DVB (10058): dsbr100: fix codingstyle, add dev_err messages

We should make if-constructions more clear. Introduce int retval
variables in some functions to make it this way. Also a lot of useful
dev_err messages added. And now we check every returned value after
usb_control_msg.
Signed-off-by: default avatarAlexey Klimov <klimov.linux@gmail.com>
Signed-off-by: default avatarDouglas Schilling Landgraf <dougsland@redhat.com>
Signed-off-by: default avatarMauro Carvalho Chehab <mchehab@redhat.com>
parent 290588e0
...@@ -197,86 +197,169 @@ static struct usb_driver usb_dsbr100_driver = { ...@@ -197,86 +197,169 @@ static struct usb_driver usb_dsbr100_driver = {
/* switch on radio */ /* switch on radio */
static int dsbr100_start(struct dsbr100_device *radio) static int dsbr100_start(struct dsbr100_device *radio)
{ {
int retval;
int request;
mutex_lock(&radio->lock); mutex_lock(&radio->lock);
if (usb_control_msg(radio->usbdev, usb_rcvctrlpipe(radio->usbdev, 0),
retval = usb_control_msg(radio->usbdev,
usb_rcvctrlpipe(radio->usbdev, 0),
USB_REQ_GET_STATUS, USB_REQ_GET_STATUS,
USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN, USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN,
0x00, 0xC7, radio->transfer_buffer, 8, 300) < 0 || 0x00, 0xC7, radio->transfer_buffer, 8, 300);
usb_control_msg(radio->usbdev, usb_rcvctrlpipe(radio->usbdev, 0),
if (retval < 0) {
request = USB_REQ_GET_STATUS;
goto usb_control_msg_failed;
}
retval = usb_control_msg(radio->usbdev,
usb_rcvctrlpipe(radio->usbdev, 0),
DSB100_ONOFF, DSB100_ONOFF,
USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN, USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN,
0x01, 0x00, radio->transfer_buffer, 8, 300) < 0) { 0x01, 0x00, radio->transfer_buffer, 8, 300);
mutex_unlock(&radio->lock);
return -1; if (retval < 0) {
request = DSB100_ONOFF;
goto usb_control_msg_failed;
} }
radio->muted=0; radio->muted = 0;
mutex_unlock(&radio->lock); mutex_unlock(&radio->lock);
return (radio->transfer_buffer)[0]; return (radio->transfer_buffer)[0];
usb_control_msg_failed:
mutex_unlock(&radio->lock);
dev_err(&radio->usbdev->dev,
"%s - usb_control_msg returned %i, request %i\n",
__func__, retval, request);
return -1;
} }
/* switch off radio */ /* switch off radio */
static int dsbr100_stop(struct dsbr100_device *radio) static int dsbr100_stop(struct dsbr100_device *radio)
{ {
int retval;
int request;
mutex_lock(&radio->lock); mutex_lock(&radio->lock);
if (usb_control_msg(radio->usbdev, usb_rcvctrlpipe(radio->usbdev, 0),
retval = usb_control_msg(radio->usbdev,
usb_rcvctrlpipe(radio->usbdev, 0),
USB_REQ_GET_STATUS, USB_REQ_GET_STATUS,
USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN, USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN,
0x16, 0x1C, radio->transfer_buffer, 8, 300) < 0 || 0x16, 0x1C, radio->transfer_buffer, 8, 300);
usb_control_msg(radio->usbdev, usb_rcvctrlpipe(radio->usbdev, 0),
if (retval < 0) {
request = USB_REQ_GET_STATUS;
goto usb_control_msg_failed;
}
retval = usb_control_msg(radio->usbdev,
usb_rcvctrlpipe(radio->usbdev, 0),
DSB100_ONOFF, DSB100_ONOFF,
USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN, USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN,
0x00, 0x00, radio->transfer_buffer, 8, 300) < 0) { 0x00, 0x00, radio->transfer_buffer, 8, 300);
mutex_unlock(&radio->lock);
return -1; if (retval < 0) {
request = DSB100_ONOFF;
goto usb_control_msg_failed;
} }
radio->muted=1; radio->muted = 1;
mutex_unlock(&radio->lock); mutex_unlock(&radio->lock);
return (radio->transfer_buffer)[0]; return (radio->transfer_buffer)[0];
usb_control_msg_failed:
mutex_unlock(&radio->lock);
dev_err(&radio->usbdev->dev,
"%s - usb_control_msg returned %i, request %i\n",
__func__, retval, request);
return -1;
} }
/* set a frequency, freq is defined by v4l's TUNER_LOW, i.e. 1/16th kHz */ /* set a frequency, freq is defined by v4l's TUNER_LOW, i.e. 1/16th kHz */
static int dsbr100_setfreq(struct dsbr100_device *radio, int freq) static int dsbr100_setfreq(struct dsbr100_device *radio, int freq)
{ {
int retval;
int request;
freq = (freq / 16 * 80) / 1000 + 856; freq = (freq / 16 * 80) / 1000 + 856;
mutex_lock(&radio->lock); mutex_lock(&radio->lock);
if (usb_control_msg(radio->usbdev, usb_rcvctrlpipe(radio->usbdev, 0),
retval = usb_control_msg(radio->usbdev,
usb_rcvctrlpipe(radio->usbdev, 0),
DSB100_TUNE, DSB100_TUNE,
USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN, USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN,
(freq >> 8) & 0x00ff, freq & 0xff, (freq >> 8) & 0x00ff, freq & 0xff,
radio->transfer_buffer, 8, 300) < 0 || radio->transfer_buffer, 8, 300);
usb_control_msg(radio->usbdev, usb_rcvctrlpipe(radio->usbdev, 0),
if (retval < 0) {
request = DSB100_TUNE;
goto usb_control_msg_failed;
}
retval = usb_control_msg(radio->usbdev,
usb_rcvctrlpipe(radio->usbdev, 0),
USB_REQ_GET_STATUS, USB_REQ_GET_STATUS,
USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN, USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN,
0x96, 0xB7, radio->transfer_buffer, 8, 300) < 0 || 0x96, 0xB7, radio->transfer_buffer, 8, 300);
usb_control_msg(radio->usbdev, usb_rcvctrlpipe(radio->usbdev, 0),
if (retval < 0) {
request = USB_REQ_GET_STATUS;
goto usb_control_msg_failed;
}
retval = usb_control_msg(radio->usbdev,
usb_rcvctrlpipe(radio->usbdev, 0),
USB_REQ_GET_STATUS, USB_REQ_GET_STATUS,
USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN, USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN,
0x00, 0x24, radio->transfer_buffer, 8, 300) < 0) { 0x00, 0x24, radio->transfer_buffer, 8, 300);
radio->stereo = -1;
mutex_unlock(&radio->lock); if (retval < 0) {
return -1; request = USB_REQ_GET_STATUS;
goto usb_control_msg_failed;
} }
radio->stereo = !((radio->transfer_buffer)[0] & 0x01); radio->stereo = !((radio->transfer_buffer)[0] & 0x01);
mutex_unlock(&radio->lock); mutex_unlock(&radio->lock);
return (radio->transfer_buffer)[0]; return (radio->transfer_buffer)[0];
usb_control_msg_failed:
radio->stereo = -1;
mutex_unlock(&radio->lock);
dev_err(&radio->usbdev->dev,
"%s - usb_control_msg returned %i, request %i\n",
__func__, retval, request);
return -1;
} }
/* return the device status. This is, in effect, just whether it /* return the device status. This is, in effect, just whether it
sees a stereo signal or not. Pity. */ sees a stereo signal or not. Pity. */
static void dsbr100_getstat(struct dsbr100_device *radio) static void dsbr100_getstat(struct dsbr100_device *radio)
{ {
int retval;
mutex_lock(&radio->lock); mutex_lock(&radio->lock);
if (usb_control_msg(radio->usbdev, usb_rcvctrlpipe(radio->usbdev, 0),
retval = usb_control_msg(radio->usbdev,
usb_rcvctrlpipe(radio->usbdev, 0),
USB_REQ_GET_STATUS, USB_REQ_GET_STATUS,
USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN, USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN,
0x00 , 0x24, radio->transfer_buffer, 8, 300) < 0) 0x00 , 0x24, radio->transfer_buffer, 8, 300);
if (retval < 0) {
radio->stereo = -1; radio->stereo = -1;
else 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); radio->stereo = !(radio->transfer_buffer[0] & 0x01);
}
mutex_unlock(&radio->lock); mutex_unlock(&radio->lock);
} }
...@@ -358,13 +441,15 @@ static int vidioc_s_frequency(struct file *file, void *priv, ...@@ -358,13 +441,15 @@ static int vidioc_s_frequency(struct file *file, void *priv,
struct v4l2_frequency *f) struct v4l2_frequency *f)
{ {
struct dsbr100_device *radio = video_drvdata(file); struct dsbr100_device *radio = video_drvdata(file);
int retval;
/* safety check */ /* safety check */
if (radio->removed) if (radio->removed)
return -EIO; return -EIO;
radio->curfreq = f->frequency; radio->curfreq = f->frequency;
if (dsbr100_setfreq(radio, radio->curfreq) == -1) retval = dsbr100_setfreq(radio, radio->curfreq);
if (retval == -1)
dev_warn(&radio->usbdev->dev, "Set frequency failed\n"); dev_warn(&radio->usbdev->dev, "Set frequency failed\n");
return 0; return 0;
} }
...@@ -418,6 +503,7 @@ static int vidioc_s_ctrl(struct file *file, void *priv, ...@@ -418,6 +503,7 @@ static int vidioc_s_ctrl(struct file *file, void *priv,
struct v4l2_control *ctrl) struct v4l2_control *ctrl)
{ {
struct dsbr100_device *radio = video_drvdata(file); struct dsbr100_device *radio = video_drvdata(file);
int retval;
/* safety check */ /* safety check */
if (radio->removed) if (radio->removed)
...@@ -426,13 +512,15 @@ static int vidioc_s_ctrl(struct file *file, void *priv, ...@@ -426,13 +512,15 @@ static int vidioc_s_ctrl(struct file *file, void *priv,
switch (ctrl->id) { switch (ctrl->id) {
case V4L2_CID_AUDIO_MUTE: case V4L2_CID_AUDIO_MUTE:
if (ctrl->value) { if (ctrl->value) {
if (dsbr100_stop(radio) == -1) { retval = dsbr100_stop(radio);
if (retval == -1) {
dev_warn(&radio->usbdev->dev, dev_warn(&radio->usbdev->dev,
"Radio did not respond properly\n"); "Radio did not respond properly\n");
return -EBUSY; return -EBUSY;
} }
} else { } else {
if (dsbr100_start(radio) == -1) { retval = dsbr100_start(radio);
if (retval == -1) {
dev_warn(&radio->usbdev->dev, dev_warn(&radio->usbdev->dev,
"Radio did not respond properly\n"); "Radio did not respond properly\n");
return -EBUSY; return -EBUSY;
...@@ -484,7 +572,8 @@ static int usb_dsbr100_open(struct inode *inode, struct file *file) ...@@ -484,7 +572,8 @@ static int usb_dsbr100_open(struct inode *inode, struct file *file)
radio->users = 1; radio->users = 1;
radio->muted = 1; radio->muted = 1;
if (dsbr100_start(radio) < 0) { retval = dsbr100_start(radio);
if (retval < 0) {
dev_warn(&radio->usbdev->dev, dev_warn(&radio->usbdev->dev,
"Radio did not start up properly\n"); "Radio did not start up properly\n");
radio->users = 0; radio->users = 0;
...@@ -493,7 +582,6 @@ static int usb_dsbr100_open(struct inode *inode, struct file *file) ...@@ -493,7 +582,6 @@ static int usb_dsbr100_open(struct inode *inode, struct file *file)
} }
retval = dsbr100_setfreq(radio, radio->curfreq); retval = dsbr100_setfreq(radio, radio->curfreq);
if (retval == -1) if (retval == -1)
dev_warn(&radio->usbdev->dev, dev_warn(&radio->usbdev->dev,
"set frequency failed\n"); "set frequency failed\n");
...@@ -601,6 +689,7 @@ static int usb_dsbr100_probe(struct usb_interface *intf, ...@@ -601,6 +689,7 @@ static int usb_dsbr100_probe(struct usb_interface *intf,
const struct usb_device_id *id) const struct usb_device_id *id)
{ {
struct dsbr100_device *radio; struct dsbr100_device *radio;
int retval;
radio = kmalloc(sizeof(struct dsbr100_device), GFP_KERNEL); radio = kmalloc(sizeof(struct dsbr100_device), GFP_KERNEL);
...@@ -622,7 +711,8 @@ static int usb_dsbr100_probe(struct usb_interface *intf, ...@@ -622,7 +711,8 @@ static int usb_dsbr100_probe(struct usb_interface *intf,
radio->usbdev = interface_to_usbdev(intf); radio->usbdev = interface_to_usbdev(intf);
radio->curfreq = FREQ_MIN * FREQ_MUL; radio->curfreq = FREQ_MIN * FREQ_MUL;
video_set_drvdata(&radio->videodev, radio); video_set_drvdata(&radio->videodev, radio);
if (video_register_device(&radio->videodev, VFL_TYPE_RADIO, radio_nr) < 0) { retval = video_register_device(&radio->videodev, VFL_TYPE_RADIO, radio_nr);
if (retval < 0) {
dev_warn(&intf->dev, "Could not register video device\n"); dev_warn(&intf->dev, "Could not register video device\n");
kfree(radio->transfer_buffer); kfree(radio->transfer_buffer);
kfree(radio); kfree(radio);
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment