diff --git a/drivers/staging/line6/toneport.c b/drivers/staging/line6/toneport.c index d894f4851ef2b341097380508d3c416265f61cd3..eaa1229002aac2d8e46c54589296ebf6f029ebff 100644 --- a/drivers/staging/line6/toneport.c +++ b/drivers/staging/line6/toneport.c @@ -75,34 +75,43 @@ static struct line6_pcm_properties toneport_pcm_properties = { /* For the led on Guitarport. - Brightness goes from 0x00 to 0x26. Set a value above this to have led blink. + Brightness goes from 0x00 to 0x26. Set a value above this to have led + blink. (void cmd_0x02(byte red, byte green) */ static int led_red = 0x00; static int led_green = 0x26; -static void toneport_update_led(struct device *dev) { - struct usb_interface *interface; - struct usb_line6_toneport *tp; - struct usb_line6* line6; +static void toneport_update_led(struct device *dev) +{ + struct usb_interface *interface = to_usb_interface(dev); + struct usb_line6_toneport *tp = usb_get_intfdata(interface); + struct usb_line6 *line6; - if ((interface = to_usb_interface(dev)) && - (tp = usb_get_intfdata(interface)) && - (line6 = &tp->line6)) - toneport_send_cmd(line6->usbdev, (led_red<<8)|0x0002, led_green); // for setting the LED on Guitarport + if (!tp) + return; + + line6 = &tp->line6; + if (line6) + toneport_send_cmd(line6->usbdev, (led_red << 8) | 0x0002, + led_green); } + static ssize_t toneport_set_led_red(struct device *dev, struct device_attribute *attr, - const char *buf, size_t count) { - char* c; + const char *buf, size_t count) +{ + char *c; led_red = simple_strtol(buf, &c, 10); toneport_update_led(dev); return count; } + static ssize_t toneport_set_led_green(struct device *dev, struct device_attribute *attr, - const char *buf, size_t count) { - char* c; + const char *buf, size_t count) +{ + char *c; led_green = simple_strtol(buf, &c, 10); toneport_update_led(dev); return count; @@ -115,11 +124,12 @@ static DEVICE_ATTR(led_green, S_IWUGO | S_IRUGO, line6_nop_read, toneport_set_le static int toneport_send_cmd(struct usb_device *usbdev, int cmd1, int cmd2) { int ret; - ret = usb_control_msg(usbdev, usb_sndctrlpipe(usbdev,0), 0x67, - USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_OUT, - cmd1, cmd2, NULL, 0, LINE6_TIMEOUT * HZ); - if(ret < 0) { + ret = usb_control_msg(usbdev, usb_sndctrlpipe(usbdev, 0), 0x67, + USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_OUT, + cmd1, cmd2, NULL, 0, LINE6_TIMEOUT * HZ); + + if (ret < 0) { err("send failed (error %d)\n", ret); return ret; } @@ -135,38 +145,44 @@ static void toneport_destruct(struct usb_interface *interface) struct usb_line6_toneport *toneport = usb_get_intfdata(interface); struct usb_line6 *line6; - if(toneport == NULL) return; + if (toneport == NULL) + return; line6 = &toneport->line6; - if(line6 == NULL) return; + if (line6 == NULL) + return; line6_cleanup_audio(line6); } /* Init Toneport device. */ -int toneport_init(struct usb_interface *interface, struct usb_line6_toneport *toneport) +int toneport_init(struct usb_interface *interface, + struct usb_line6_toneport *toneport) { int err, ticks; struct usb_line6 *line6 = &toneport->line6; struct usb_device *usbdev; - if((interface == NULL) || (toneport == NULL)) + if ((interface == NULL) || (toneport == NULL)) return -ENODEV; /* initialize audio system: */ - if((err = line6_init_audio(line6)) < 0) { + err = line6_init_audio(line6); + if (err < 0) { toneport_destruct(interface); return err; } /* initialize PCM subsystem: */ - if((err = line6_init_pcm(line6, &toneport_pcm_properties)) < 0) { + err = line6_init_pcm(line6, &toneport_pcm_properties); + if (err < 0) { toneport_destruct(interface); return err; } /* register audio system: */ - if((err = line6_register_audio(line6)) < 0) { + err = line6_register_audio(line6); + if (err < 0) { toneport_destruct(interface); return err; } @@ -182,11 +198,12 @@ int toneport_init(struct usb_interface *interface, struct usb_line6_toneport *to /* seems to work without the first two... */ - //toneport_send_cmd(usbdev, 0x0201, 0x0002); // .. - //toneport_send_cmd(usbdev, 0x0801, 0x0000); // .. - toneport_send_cmd(usbdev, 0x0301, 0x0000); // only one that works for me; on GP, TP might be different? + /* toneport_send_cmd(usbdev, 0x0201, 0x0002); */ + /* toneport_send_cmd(usbdev, 0x0801, 0x0000); */ + /* only one that works for me; on GP, TP might be different? */ + toneport_send_cmd(usbdev, 0x0301, 0x0000); - if (usbdev->descriptor.idProduct!=LINE6_DEVID_GUITARPORT) { + if (usbdev->descriptor.idProduct != LINE6_DEVID_GUITARPORT) { CHECK_RETURN(device_create_file(&interface->dev, &dev_attr_led_red)); CHECK_RETURN(device_create_file(&interface->dev, &dev_attr_led_green)); toneport_update_led(&usbdev->dev); @@ -202,7 +219,8 @@ void toneport_disconnect(struct usb_interface *interface) { struct usb_line6_toneport *toneport; - if(interface == NULL) return; + if (interface == NULL) + return; toneport = usb_get_intfdata(interface); if (toneport->line6.usbdev->descriptor.idProduct != LINE6_DEVID_GUITARPORT) { @@ -210,10 +228,10 @@ void toneport_disconnect(struct usb_interface *interface) device_remove_file(&interface->dev, &dev_attr_led_green); } - if(toneport != NULL) { + if (toneport != NULL) { struct snd_line6_pcm *line6pcm = toneport->line6.line6pcm; - if(line6pcm != NULL) { + if (line6pcm != NULL) { unlink_wait_clear_audio_out_urbs(line6pcm); unlink_wait_clear_audio_in_urbs(line6pcm); }