diff options
Diffstat (limited to 'liblights/lights.c')
-rw-r--r-- | liblights/lights.c | 339 |
1 files changed, 339 insertions, 0 deletions
diff --git a/liblights/lights.c b/liblights/lights.c new file mode 100644 index 0000000..d439eda --- /dev/null +++ b/liblights/lights.c @@ -0,0 +1,339 @@ +/* + * Copyright (C) 2013 The Android Open Source Project + * Copyright (C) 2015 The CyanogenMod Project + * + * Licensed under the Apache License, Version 2.0 (the "License"); + * you may not use this file except in compliance with the License. + * You may obtain a copy of the License at + * + * http://www.apache.org/licenses/LICENSE-2.0 + * + * Unless required by applicable law or agreed to in writing, software + * distributed under the License is distributed on an "AS IS" BASIS, + * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. + * See the License for the specific language governing permissions and + * limitations under the License. + */ + +#define LOG_TAG "SamsungLightsHAL" +/* #define LOG_NDEBUG 0 */ + +#include <cutils/log.h> +#include <stdlib.h> +#include <string.h> +#include <unistd.h> +#include <errno.h> +#include <fcntl.h> +#include <pthread.h> + +#include <sys/ioctl.h> +#include <sys/types.h> + +#include <hardware/lights.h> + +#define PANEL_FILE "/sys/class/backlight/panel/brightness" +#define BUTTON_FILE "/sys/class/sec/sec_touchkey/brightness" +#define LED_BLINK "/sys/class/sec/led/led_blink" + +#define COLOR_MASK 0x00ffffff + +static pthread_once_t g_init = PTHREAD_ONCE_INIT; +static pthread_mutex_t g_lock = PTHREAD_MUTEX_INITIALIZER; + +struct led_config { + unsigned int color; + int delay_on, delay_off; +}; + +static struct led_config g_leds[3]; // For battery, notifications, and attention. +static int g_cur_led = -1; // Presently showing LED of the above. + +void init_g_lock(void) +{ + pthread_mutex_init(&g_lock, NULL); +} + +static int write_int(char const *path, int value) +{ + int fd; + static int already_warned; + + already_warned = 0; + + ALOGV("write_int: path %s, value %d", path, value); + fd = open(path, O_RDWR); + + if (fd >= 0) { + char buffer[20]; + int bytes = sprintf(buffer, "%d\n", value); + int amt = write(fd, buffer, bytes); + close(fd); + return amt == -1 ? -errno : 0; + } else { + if (already_warned == 0) { + ALOGE("write_int failed to open %s\n", path); + already_warned = 1; + } + return -errno; + } +} + +static int write_str(char const *path, const char* value) +{ + int fd; + static int already_warned; + + already_warned = 0; + + ALOGV("write_str: path %s, value %s", path, value); + fd = open(path, O_RDWR); + + if (fd >= 0) { + int amt = write(fd, value, strlen(value)); + close(fd); + return amt == -1 ? -errno : 0; + } else { + if (already_warned == 0) { + ALOGE("write_str failed to open %s\n", path); + already_warned = 1; + } + return -errno; + } +} + +static int rgb_to_brightness(struct light_state_t const *state) +{ + int color = state->color & COLOR_MASK; + + return ((77*((color>>16) & 0x00ff)) + + (150*((color>>8) & 0x00ff)) + (29*(color & 0x00ff))) >> 8; +} + +static int set_light_backlight(struct light_device_t *dev __unused, + struct light_state_t const *state) +{ + int err = 0; + int brightness = rgb_to_brightness(state); + + pthread_mutex_lock(&g_lock); + err = write_int(PANEL_FILE, brightness); + + pthread_mutex_unlock(&g_lock); + return err; +} + +static int set_light_buttons(struct light_device_t* dev __unused, + struct light_state_t const* state) +{ + int err = 0; + int on = (state->color & COLOR_MASK); + + pthread_mutex_lock(&g_lock); + + err = write_int(BUTTON_FILE, on ? 1 : 0); + + pthread_mutex_unlock(&g_lock); + + return err; +} + +static int close_lights(struct light_device_t *dev) +{ + ALOGV("close_light is called"); + if (dev) + free(dev); + + return 0; +} + +/* LEDs */ +static int write_leds(const struct led_config *led) +{ + static const struct led_config led_off = {0, 0, 0}; + + char blink[32]; + int count, err; + int color; + + if (led == NULL) + led = &led_off; + + count = snprintf(blink, + sizeof(blink) - 1, + "0x%08x %d %d", + led->color, + led->delay_on, + led->delay_off); + if (count < 0) { + return -errno; + } else if ((unsigned int)count >= sizeof(blink)-1) { + ALOGE("%s: Truncated string: blink=\"%s\".", __func__, blink); + return -EINVAL; + } + + ALOGV("%s: color=0x%08x, delay_on=%d, delay_off=%d, blink=\"%s\".", + __func__, led->color, led->delay_on, led->delay_off, blink); + + /* Add '\n' here to make the above log message clean. */ + blink[count] = '\n'; + blink[count+1] = '\0'; + + pthread_mutex_lock(&g_lock); + err = write_str(LED_BLINK, blink); + pthread_mutex_unlock(&g_lock); + + return err; +} + +static int set_light_leds(struct light_state_t const *state, int type) +{ + struct led_config *led; + int err = 0; + + ALOGV("%s: type=%d, color=0x%010x, fM=%d, fOnMS=%d, fOffMs=%d.", __func__, + type, state->color,state->flashMode, state->flashOnMS, state->flashOffMS); + + if (type < 0 || (size_t)type >= sizeof(g_leds)/sizeof(g_leds[0])) { + return -EINVAL; + } + + /* type is one of: + * 0. battery + * 1. notifications + * 2. attention + * which are multiplexed onto the same physical LED in the above order. */ + led = &g_leds[type]; + + switch (state->flashMode) { + case LIGHT_FLASH_NONE: + /* Set LED to a solid color, spec is unclear on the exact behavior here. */ + led->delay_on = led->delay_off = 0; + break; + case LIGHT_FLASH_TIMED: + case LIGHT_FLASH_HARDWARE: + led->delay_on = state->flashOnMS; + led->delay_off = state->flashOffMS; + break; + default: + return -EINVAL; + } + + led->color = state->color & COLOR_MASK; + + if (led->color > 0) { + /* This LED is lit. */ + if (type >= g_cur_led) { + /* And it has the highest priority, so show it. */ + err = write_leds(led); + g_cur_led = type; + } + } else { + /* This LED is not (any longer) lit. */ + if (type == g_cur_led) { + /* But it is currently showing, switch to a lower-priority LED. */ + int i; + + for (i = type-1; i >= 0; i--) { + if (g_leds[i].color > 0) { + /* Found a lower-priority LED to switch to. */ + err = write_leds(&g_leds[i]); + goto switched; + } + } + + /* No LEDs are lit, turn off. */ + err = write_leds(NULL); +switched: + g_cur_led = i; + } + } + + return err; +} + +static int set_light_leds_battery(struct light_device_t *dev __unused, + struct light_state_t const *state) +{ + return set_light_leds(state, 0); +} + +static int set_light_leds_notifications(struct light_device_t *dev __unused, + struct light_state_t const *state) +{ + return set_light_leds(state, 1); +} + +static int set_light_leds_attention(struct light_device_t *dev __unused, + struct light_state_t const *state) +{ + struct light_state_t fixed; + + memcpy(&fixed, state, sizeof(fixed)); + + /* The framework does odd things with the attention lights, fix them up to + * do something sensible here. */ + switch (fixed.flashMode) { + case LIGHT_FLASH_NONE: + /* LightsService.Light::stopFlashing calls with non-zero color. */ + fixed.color = 0; + break; + case LIGHT_FLASH_HARDWARE: + /* PowerManagerService::setAttentionLight calls with onMS=3, offMS=0, which + * just makes for a slightly-dimmer LED. */ + if (fixed.flashOnMS > 0 && fixed.flashOffMS == 0) + fixed.flashMode = LIGHT_FLASH_NONE; + fixed.color = 0x000000ff; + break; + } + + return set_light_leds(&fixed, 2); +} + +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); + + if (0 == strcmp(LIGHT_ID_BACKLIGHT, name)) + set_light = set_light_backlight; + else if (0 == strcmp(LIGHT_ID_BUTTONS, name)) + set_light = set_light_buttons; + else if (0 == strcmp(LIGHT_ID_BATTERY, name)) + set_light = set_light_leds_battery; + 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_once(&g_init, init_g_lock); + + struct light_device_t *dev = malloc(sizeof(struct light_device_t)); + memset(dev, 0, sizeof(*dev)); + + dev->common.tag = HARDWARE_DEVICE_TAG; + dev->common.version = 0; + dev->common.module = (struct hw_module_t *)module; + dev->common.close = (int (*)(struct hw_device_t *))close_lights; + dev->set_light = set_light; + + *device = (struct hw_device_t *)dev; + + return 0; +} + +static struct hw_module_methods_t lights_module_methods = { + .open = open_lights, +}; + +struct hw_module_t HAL_MODULE_INFO_SYM = { + .tag = HARDWARE_MODULE_TAG, + .version_major = 1, + .version_minor = 0, + .id = LIGHTS_HARDWARE_MODULE_ID, + .name = "Samsung Lights Module", + .author = "The CyanogenMod Project", + .methods = &lights_module_methods, +}; |