mirror of
https://github.com/wessel-novacustom/clevo-keyboard.git
synced 2024-11-15 03:34:01 +01:00
Initial classdev lightbar support
This commit is contained in:
parent
8c0a618f6b
commit
821c502823
|
@ -24,6 +24,7 @@
|
|||
#include <linux/keyboard.h>
|
||||
#include <linux/timer.h>
|
||||
#include <linux/delay.h>
|
||||
#include <linux/leds.h>
|
||||
|
||||
#define UNIWILL_WMI_MGMT_GUID_BA "ABBC0F6D-8EA1-11D1-00A0-C90629100000"
|
||||
#define UNIWILL_WMI_MGMT_GUID_BB "ABBC0F6E-8EA1-11D1-00A0-C90629100000"
|
||||
|
@ -585,9 +586,113 @@ static int uw_kbd_bl_init(struct platform_device *dev)
|
|||
return status;
|
||||
}
|
||||
|
||||
static int uniwill_keyboard_probe(struct platform_device *dev)
|
||||
#define UNIWILL_LIGHTBAR_LED_MAX_BRIGHTNESS 0x24
|
||||
|
||||
static void uniwill_write_lightbar_rgb(u8 red, u8 green, u8 blue)
|
||||
{
|
||||
union uw_ec_write_return reg_write_return;
|
||||
|
||||
uw_ec_write_func *__uw_ec_write_addr;
|
||||
|
||||
__uw_ec_write_addr = symbol_get(uw_ec_write_addr);
|
||||
|
||||
if (__uw_ec_write_addr) {
|
||||
if (red <= UNIWILL_LIGHTBAR_LED_MAX_BRIGHTNESS) {
|
||||
__uw_ec_write_addr(0x49, 0x07, red, 0x00, ®_write_return);
|
||||
}
|
||||
if (green <= UNIWILL_LIGHTBAR_LED_MAX_BRIGHTNESS) {
|
||||
__uw_ec_write_addr(0x4a, 0x07, green, 0x00, ®_write_return);
|
||||
}
|
||||
if (blue <= UNIWILL_LIGHTBAR_LED_MAX_BRIGHTNESS) {
|
||||
__uw_ec_write_addr(0x4b, 0x07, blue, 0x00, ®_write_return);
|
||||
}
|
||||
} else {
|
||||
TUXEDO_DEBUG("tuxedo-cc-wmi symbols not found\n");
|
||||
}
|
||||
|
||||
if (__uw_ec_write_addr) symbol_put(uw_ec_write_addr);
|
||||
}
|
||||
|
||||
static int uniwill_read_lightbar_rgb(u8 *red, u8 *green, u8 *blue)
|
||||
{
|
||||
int status;
|
||||
union uw_ec_read_return reg_read_return;
|
||||
|
||||
uw_ec_read_func *__uw_ec_read_addr;
|
||||
|
||||
__uw_ec_read_addr = symbol_get(uw_ec_read_addr);
|
||||
|
||||
if (__uw_ec_read_addr) {
|
||||
__uw_ec_read_addr(0x49, 0x07, ®_read_return);
|
||||
*red = reg_read_return.bytes.data_low;
|
||||
__uw_ec_read_addr(0x4a, 0x07, ®_read_return);
|
||||
*green = reg_read_return.bytes.data_low;
|
||||
__uw_ec_read_addr(0x4b, 0x07, ®_read_return);
|
||||
*blue = reg_read_return.bytes.data_low;
|
||||
status = 0;
|
||||
} else {
|
||||
status = -EIO;
|
||||
TUXEDO_DEBUG("tuxedo-cc-wmi symbols not found\n");
|
||||
}
|
||||
|
||||
if (__uw_ec_read_addr) symbol_put(uw_ec_read_addr);
|
||||
|
||||
return status;
|
||||
}
|
||||
|
||||
static int lightbar_set_blocking(struct led_classdev *led_cdev, enum led_brightness brightness)
|
||||
{
|
||||
u8 red = 0xff, green = 0xff, blue = 0xff;
|
||||
if (strpbrk(led_cdev->name, "red") != 0) {
|
||||
red = brightness;
|
||||
} else if (strpbrk(led_cdev->name, "green") != 0) {
|
||||
green = brightness;
|
||||
} else if (strpbrk(led_cdev->name, "blue") != 0) {
|
||||
blue = brightness;
|
||||
}
|
||||
uniwill_write_lightbar_rgb(red, green, blue);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static enum led_brightness lightbar_get(struct led_classdev *led_cdev)
|
||||
{
|
||||
u8 red, green, blue;
|
||||
uniwill_read_lightbar_rgb(&red, &green, &blue);
|
||||
if (strpbrk(led_cdev->name, "red") != 0) {
|
||||
return red;
|
||||
} else if (strpbrk(led_cdev->name, "green") != 0) {
|
||||
return green;
|
||||
} else if (strpbrk(led_cdev->name, "blue") != 0) {
|
||||
return blue;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static struct led_classdev lightbar_led_classdevs[] = {
|
||||
{
|
||||
.name = "tuxedo:red:lightbar",
|
||||
.max_brightness = UNIWILL_LIGHTBAR_LED_MAX_BRIGHTNESS,
|
||||
.brightness_set_blocking = &lightbar_set_blocking,
|
||||
.brightness_get = &lightbar_get
|
||||
},
|
||||
{
|
||||
.name = "tuxedo:green:lightbar",
|
||||
.max_brightness = UNIWILL_LIGHTBAR_LED_MAX_BRIGHTNESS,
|
||||
.brightness_set_blocking = &lightbar_set_blocking,
|
||||
.brightness_get = &lightbar_get
|
||||
},
|
||||
{
|
||||
.name = "tuxedo:blue:lightbar",
|
||||
.max_brightness = UNIWILL_LIGHTBAR_LED_MAX_BRIGHTNESS,
|
||||
.brightness_set_blocking = &lightbar_set_blocking,
|
||||
.brightness_get = &lightbar_get
|
||||
}
|
||||
};
|
||||
|
||||
static int uniwill_keyboard_probe(struct platform_device *dev)
|
||||
{
|
||||
int status, i;
|
||||
|
||||
// Look for for GUIDs used on uniwill devices
|
||||
status =
|
||||
|
@ -626,6 +731,10 @@ static int uniwill_keyboard_probe(struct platform_device *dev)
|
|||
|
||||
uw_kbd_bl_init(dev);
|
||||
|
||||
for (i = 0; i < 3; ++i) {
|
||||
led_classdev_register(&dev->dev, &lightbar_led_classdevs[i]);
|
||||
}
|
||||
|
||||
return 0;
|
||||
|
||||
err_remove_notifiers:
|
||||
|
@ -638,6 +747,8 @@ err_remove_notifiers:
|
|||
|
||||
static int uniwill_keyboard_remove(struct platform_device *dev)
|
||||
{
|
||||
int i;
|
||||
|
||||
// Restore previous backlight enable state
|
||||
if (uniwill_kbd_bl_enable_state_on_start != 0xff) {
|
||||
if (uniwill_kbd_bl_type_rgb_single_color)
|
||||
|
@ -652,6 +763,10 @@ static int uniwill_keyboard_remove(struct platform_device *dev)
|
|||
|
||||
del_timer(&uw_kbd_bl_init_timer);
|
||||
|
||||
for (i = 0; i < 3; ++i) {
|
||||
led_classdev_unregister(&lightbar_led_classdevs[i]);
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
|
Loading…
Reference in a new issue