ALSA: line6/toneport: Implement LED controls via LED class
Instead of non-standard sysfs, reimplement the LED controls on TonePort as LED class devices. Tested-by: Chris Rorvick <chris@rorvick.com> Signed-off-by: Takashi Iwai <tiwai@suse.de>
This commit is contained in:
parent
bf115fcf95
commit
f44edd7b2b
2 changed files with 91 additions and 74 deletions
|
@ -29,6 +29,8 @@ config SND_USB_PODHD
|
|||
config SND_USB_TONEPORT
|
||||
tristate "TonePort GX, UX1 and UX2 USB support"
|
||||
select SND_USB_LINE6
|
||||
select NEW_LEDS
|
||||
select LEDS_CLASS
|
||||
help
|
||||
This is a driver for TonePort GX, UX1 and UX2 devices.
|
||||
|
||||
|
|
|
@ -14,6 +14,7 @@
|
|||
#include <linux/usb.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/leds.h>
|
||||
#include <sound/core.h>
|
||||
#include <sound/control.h>
|
||||
|
||||
|
@ -32,6 +33,15 @@ enum line6_device_type {
|
|||
LINE6_TONEPORT_UX2,
|
||||
};
|
||||
|
||||
struct usb_line6_toneport;
|
||||
|
||||
struct toneport_led {
|
||||
struct led_classdev dev;
|
||||
char name[64];
|
||||
struct usb_line6_toneport *toneport;
|
||||
bool registered;
|
||||
};
|
||||
|
||||
struct usb_line6_toneport {
|
||||
/**
|
||||
Generic Line 6 USB data.
|
||||
|
@ -62,6 +72,9 @@ struct usb_line6_toneport {
|
|||
Device type.
|
||||
*/
|
||||
enum line6_device_type type;
|
||||
|
||||
/* LED instances */
|
||||
struct toneport_led leds[2];
|
||||
};
|
||||
|
||||
static int toneport_send_cmd(struct usb_device *usbdev, int cmd1, int cmd2);
|
||||
|
@ -117,15 +130,6 @@ static struct line6_pcm_properties toneport_pcm_properties = {
|
|||
.bytes_per_frame = 4
|
||||
};
|
||||
|
||||
/*
|
||||
For the led on Guitarport.
|
||||
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 const struct {
|
||||
const char *name;
|
||||
int code;
|
||||
|
@ -136,62 +140,6 @@ static const struct {
|
|||
{"Inst & Mic", 0x0901}
|
||||
};
|
||||
|
||||
static bool toneport_has_led(enum line6_device_type type)
|
||||
{
|
||||
return
|
||||
(type == LINE6_GUITARPORT) ||
|
||||
(type == LINE6_TONEPORT_GX);
|
||||
/* add your device here if you are missing support for the LEDs */
|
||||
}
|
||||
|
||||
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 (!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)
|
||||
{
|
||||
int retval;
|
||||
|
||||
retval = kstrtoint(buf, 10, &led_red);
|
||||
if (retval)
|
||||
return retval;
|
||||
|
||||
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)
|
||||
{
|
||||
int retval;
|
||||
|
||||
retval = kstrtoint(buf, 10, &led_green);
|
||||
if (retval)
|
||||
return retval;
|
||||
|
||||
toneport_update_led(dev);
|
||||
return count;
|
||||
}
|
||||
|
||||
static DEVICE_ATTR(led_red, S_IWUSR | S_IRUGO, line6_nop_read,
|
||||
toneport_set_led_red);
|
||||
static DEVICE_ATTR(led_green, S_IWUSR | S_IRUGO, line6_nop_read,
|
||||
toneport_set_led_green);
|
||||
|
||||
static int toneport_send_cmd(struct usb_device *usbdev, int cmd1, int cmd2)
|
||||
{
|
||||
int ret;
|
||||
|
@ -329,6 +277,78 @@ static struct snd_kcontrol_new toneport_control_source = {
|
|||
.put = snd_toneport_source_put
|
||||
};
|
||||
|
||||
/*
|
||||
For the led on Guitarport.
|
||||
Brightness goes from 0x00 to 0x26. Set a value above this to have led
|
||||
blink.
|
||||
(void cmd_0x02(byte red, byte green)
|
||||
*/
|
||||
|
||||
static bool toneport_has_led(enum line6_device_type type)
|
||||
{
|
||||
return
|
||||
(type == LINE6_GUITARPORT) ||
|
||||
(type == LINE6_TONEPORT_GX);
|
||||
/* add your device here if you are missing support for the LEDs */
|
||||
}
|
||||
|
||||
static const char * const led_colors[2] = { "red", "green" };
|
||||
static const int led_init_vals[2] = { 0x00, 0x26 };
|
||||
|
||||
static void toneport_update_led(struct usb_line6_toneport *toneport)
|
||||
{
|
||||
toneport_send_cmd(toneport->line6.usbdev,
|
||||
(toneport->leds[0].dev.brightness << 8) | 0x0002,
|
||||
toneport->leds[1].dev.brightness);
|
||||
}
|
||||
|
||||
static void toneport_led_brightness_set(struct led_classdev *led_cdev,
|
||||
enum led_brightness brightness)
|
||||
{
|
||||
struct toneport_led *leds =
|
||||
container_of(led_cdev, struct toneport_led, dev);
|
||||
toneport_update_led(leds->toneport);
|
||||
}
|
||||
|
||||
static int toneport_init_leds(struct usb_line6_toneport *toneport)
|
||||
{
|
||||
struct device *dev = &toneport->line6.usbdev->dev;
|
||||
int i, err;
|
||||
|
||||
for (i = 0; i < 2; i++) {
|
||||
struct toneport_led *led = &toneport->leds[i];
|
||||
struct led_classdev *leddev = &led->dev;
|
||||
|
||||
led->toneport = toneport;
|
||||
snprintf(led->name, sizeof(led->name), "%s::%s",
|
||||
dev_name(dev), led_colors[i]);
|
||||
leddev->name = led->name;
|
||||
leddev->brightness = led_init_vals[i];
|
||||
leddev->max_brightness = 0x26;
|
||||
leddev->brightness_set = toneport_led_brightness_set;
|
||||
err = led_classdev_register(dev, leddev);
|
||||
if (err)
|
||||
return err;
|
||||
led->registered = true;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void toneport_remove_leds(struct usb_line6_toneport *toneport)
|
||||
{
|
||||
struct toneport_led *led;
|
||||
int i;
|
||||
|
||||
for (i = 0; i < 2; i++) {
|
||||
led = &toneport->leds[i];
|
||||
if (!led->registered)
|
||||
break;
|
||||
led_classdev_unregister(&led->dev);
|
||||
led->registered = false;
|
||||
}
|
||||
}
|
||||
|
||||
/*
|
||||
Setup Toneport device.
|
||||
*/
|
||||
|
@ -359,7 +379,7 @@ static void toneport_setup(struct usb_line6_toneport *toneport)
|
|||
}
|
||||
|
||||
if (toneport_has_led(toneport->type))
|
||||
toneport_update_led(&usbdev->dev);
|
||||
toneport_update_led(toneport);
|
||||
|
||||
mod_timer(&toneport->timer, jiffies + TONEPORT_PCM_DELAY * HZ);
|
||||
}
|
||||
|
@ -374,10 +394,8 @@ static void line6_toneport_disconnect(struct usb_interface *interface)
|
|||
toneport = usb_get_intfdata(interface);
|
||||
del_timer_sync(&toneport->timer);
|
||||
|
||||
if (toneport_has_led(toneport->type)) {
|
||||
device_remove_file(&interface->dev, &dev_attr_led_red);
|
||||
device_remove_file(&interface->dev, &dev_attr_led_green);
|
||||
}
|
||||
if (toneport_has_led(toneport->type))
|
||||
toneport_remove_leds(toneport);
|
||||
}
|
||||
|
||||
|
||||
|
@ -428,10 +446,7 @@ static int toneport_init(struct usb_interface *interface,
|
|||
line6_read_data(line6, 0x80c2, &toneport->firmware_version, 1);
|
||||
|
||||
if (toneport_has_led(toneport->type)) {
|
||||
err = device_create_file(&interface->dev, &dev_attr_led_red);
|
||||
if (err < 0)
|
||||
return err;
|
||||
err = device_create_file(&interface->dev, &dev_attr_led_green);
|
||||
err = toneport_init_leds(toneport);
|
||||
if (err < 0)
|
||||
return err;
|
||||
}
|
||||
|
|
Loading…
Reference in a new issue