diff options
Diffstat (limited to 'liblight')
| -rw-r--r--[-rwxr-xr-x] | liblight/lights.c | 150 |
1 files changed, 147 insertions, 3 deletions
diff --git a/liblight/lights.c b/liblight/lights.c index ac6eafc..74f0db4 100755..100644 --- a/liblight/lights.c +++ b/liblight/lights.c @@ -24,11 +24,68 @@ #include <sys/ioctl.h> #include <sys/types.h> #include <hardware/lights.h> +#include <linux/leds-an30259a.h> static pthread_once_t g_init = PTHREAD_ONCE_INIT; static pthread_mutex_t g_lock = PTHREAD_MUTEX_INITIALIZER; char const *const LCD_FILE = "/sys/class/backlight/s6e8aa0/brightness"; +char const *const LED_FILE = "/dev/an30259a_leds"; + +static __u8 old_imax = 1; + +/* configurations for pulse modes of NOTIFICATIONS and ATTENTION */ +/* TODO: Once google fixes values, these values should be modified. */ +struct an30259a_pulse_config_t { + __u8 imax; +}; +struct an30259a_pulse_config_t an30259a_pulse_config[2] = { + { /* notifications */ + .imax = 1, + }, + { /* attention */ + .imax = 1, + }, +}; + +/* configurations for slope mode of NOTIFICATION and ATTENTION */ +/* TODO: Once google fixes values, these values should be modified. */ +struct an30259a_slope_config_t { + __u8 imax; + struct an30259a_pr_control led; +}; + +struct an30259a_slope_config_t an30259a_slope_config[2] = { + { /* notifications */ + .imax = 1, + .led = { + .state = LED_LIGHT_SLOPE, + .start_delay = 1000, + .time_slope_up_1 = 1000, + .time_slope_up_2 = 1000, + .time_slope_down_1 = 1000, + .time_slope_down_2 = 1000, + .mid_brightness = 127, + }, + }, + { /* attention */ + .imax = 1, + .led = { + .state = LED_LIGHT_SLOPE, + .start_delay = 2000, + .time_slope_up_1 = 2000, + .time_slope_up_2 = 2000, + .time_slope_down_1 = 2000, + .time_slope_down_2 = 2000, + .mid_brightness = 127, + }, + }, +}; + +void init_g_lock(void) +{ + pthread_mutex_init(&g_lock, NULL); +} static int write_int(char const *path, int value) { @@ -85,20 +142,107 @@ static int close_lights(struct light_device_t *dev) return 0; } +/* LEDs */ +static int write_leds(struct an30259a_pr_control *led, __u8 imax) +{ + int err = 0; + int fd; + +LOGD("write_leds %d\n", imax); + pthread_mutex_lock(&g_lock); + + fd = open(LED_FILE, O_RDWR); + if (fd >= 0) { + if (imax != old_imax) { + err = ioctl(fd, AN30259A_PR_SET_IMAX, &imax); + if (err >= 0) + old_imax = imax; + else + LOGE("failed to set imax"); + } + + if (err >= 0) { + err = ioctl(fd, AN30259A_PR_SET_LED, led); + if (err < 0) + LOGE("failed to set leds!"); + } + + close(fd); + } else { + LOGE("failed to open %s!", LED_FILE); + err = -errno; + } + + pthread_mutex_unlock(&g_lock); + + return err; +} + +static int set_light_leds(struct light_state_t const *state, int type) +{ + struct an30259a_pr_control led; + __u8 imax; + + memset(&led, 0, sizeof(led)); + + switch (state->flashMode) { + case LIGHT_FLASH_NONE: +LOGD("set_light_leds LIGHT_FLASH_NONE\n"); + led.state = LED_LIGHT_OFF; + imax = old_imax; + break; + case LIGHT_FLASH_TIMED: +LOGD("set_light_leds LIGHT_FLASH_TIMED\n"); + led.state = LED_LIGHT_PULSE; + led.color = state->color & 0x00ffffff; + led.time_on = state->flashOnMS; + led.time_off = state->flashOffMS; + imax = an30259a_pulse_config[type].imax; + break; + case LIGHT_FLASH_HARDWARE: +LOGD("set_light_leds LIGHT_FLASH_HARDWARE\n"); + led = an30259a_slope_config[type].led; + led.color = state->color & 0x00ffffff; + led.time_on = state->flashOnMS; + led.time_off = state->flashOffMS; + imax = an30259a_slope_config[type].imax; + break; + default: +LOGD("set_light_leds EINVAL\n"); + return -EINVAL; + } + + return write_leds(&led, imax); +} + +static int set_light_leds_notifications(struct light_device_t *dev, + struct light_state_t const *state) +{ + return set_light_leds(state, 0); +} + +static int set_light_leds_attention(struct light_device_t *dev, + struct light_state_t const *state) +{ + return set_light_leds(state, 1); +} + static int open_lights(const struct hw_module_t *module, char const *name, struct hw_device_t **device) { int (*set_light)(struct light_device_t *dev, struct light_state_t const *state); - LOGV("open_lights: open with %s", name); - if (0 == strcmp(LIGHT_ID_BACKLIGHT, name)) set_light = set_light_backlight; + else if (0 == strcmp(LIGHT_ID_NOTIFICATIONS, name)) + set_light = set_light_leds_notifications; + else if (0 == strcmp(LIGHT_ID_ATTENTION, name)) + set_light = set_light_leds_attention; else return -EINVAL; - pthread_mutex_init(&g_lock, NULL); + pthread_once(&g_init, init_g_lock); struct light_device_t *dev = malloc(sizeof(struct light_device_t)); memset(dev, 0, sizeof(*dev)); |