From b78b3489637b4008a2b3a8c2670df7390b79d1a8 Mon Sep 17 00:00:00 2001 From: Fedor917 Date: Thu, 10 Nov 2016 16:01:34 +0700 Subject: [PATCH] Test change lights --- liblight/lights.c | 84 ++++++++++++++++++++++++++++++++++------------- 1 file changed, 62 insertions(+), 22 deletions(-) diff --git a/liblight/lights.c b/liblight/lights.c index 4dc4abb..745b498 100644 --- a/liblight/lights.c +++ b/liblight/lights.c @@ -33,20 +33,21 @@ #include +/******************************************************************************/ + static pthread_once_t g_init = PTHREAD_ONCE_INIT; static pthread_mutex_t g_lock = PTHREAD_MUTEX_INITIALIZER; - static struct light_state_t g_attention; static struct light_state_t g_notification; static struct light_state_t g_battery; -static const char RED_LED_FILE[] +char const*const RED_LED_FILE = "/sys/class/leds/led:rgb_red/brightness"; -static const char LCD_FILE[] +char const*const LCD_FILE = "/sys/class/leds/lcd-backlight/brightness"; -static const char RED_BLINK_FILE[] +char const*const RED_BLINK_FILE = "/sys/class/leds/led:rgb_red/rgbbreath"; #define RAMP_SIZE 8 @@ -55,16 +56,17 @@ static int BRIGHTNESS_RAMP[RAMP_SIZE] #define RAMP_STEP_DURATION 50 /** - * Device methods + * device methods */ -static void init_globals(void) +void init_globals(void) { - // Init the mutex + // init the mutex pthread_mutex_init(&g_lock, NULL); } -static int write_int(char const* path, int value) +static int +write_int(char const* path, int value) { int fd; static int already_warned = 0; @@ -85,7 +87,8 @@ static int write_int(char const* path, int value) } } -static int write_str(char const* path, char* value) +static int +write_str(char const* path, char* value) { int fd; static int already_warned = 0; @@ -99,26 +102,29 @@ static int write_str(char const* path, char* value) return amt == -1 ? -errno : 0; } else { if (already_warned == 0) { - ALOGE("write_str failed to open %s\n", path); + ALOGE("write_int failed to open %s\n", path); already_warned = 1; } return -errno; } } -static int is_lit(struct light_state_t const* state) +static int +is_lit(struct light_state_t const* state) { return state->color & 0x00ffffff; } -static int rgb_to_brightness(struct light_state_t const* state) +static int +rgb_to_brightness(struct light_state_t const* state) { int color = state->color & 0x00ffffff; return ((77*((color>>16)&0x00ff)) + (150*((color>>8)&0x00ff)) + (29*(color&0x00ff))) >> 8; } -static int set_light_backlight(struct light_device_t* dev, +static int +set_light_backlight(struct light_device_t* dev, struct light_state_t const* state) { int err = 0; @@ -132,7 +138,8 @@ static int set_light_backlight(struct light_device_t* dev, return err; } -static int set_speaker_light_locked(struct light_device_t* dev, +static int +set_speaker_light_locked(struct light_device_t* dev, struct light_state_t const* state) { int red; @@ -166,7 +173,7 @@ static int set_speaker_light_locked(struct light_device_t* dev, blink = onMS > 0 && offMS > 0; - // Disable all blinking to start + // disable all blinking to start write_int(RED_BLINK_FILE, 0); if (blink) { @@ -177,7 +184,7 @@ static int set_speaker_light_locked(struct light_device_t* dev, pauseHi = 0; } - // Start the party + // start the party write_int(RED_BLINK_FILE, red); } else { @@ -188,7 +195,8 @@ static int set_speaker_light_locked(struct light_device_t* dev, return 0; } -static void handle_speaker_light_locked(struct light_device_t* dev) +static void +handle_speaker_light_locked(struct light_device_t* dev) { if (is_lit(&g_attention)) { set_speaker_light_locked(dev, &g_attention); @@ -199,7 +207,8 @@ static void handle_speaker_light_locked(struct light_device_t* dev) } } -static int set_light_battery(struct light_device_t* dev, +static int +set_light_battery(struct light_device_t* dev, struct light_state_t const* state) { pthread_mutex_lock(&g_lock); @@ -209,19 +218,47 @@ static int set_light_battery(struct light_device_t* dev, return 0; } -static int set_light_notifications(struct light_device_t* dev, +static int +set_light_notifications(struct light_device_t* dev, struct light_state_t const* state) { pthread_mutex_lock(&g_lock); + unsigned int brightness; + unsigned int color; + unsigned int rgb[3]; + g_notification = *state; + // If a brightness has been applied by the user + brightness = (g_notification.color & 0xFF000000) >> 24; + if (brightness > 0 && brightness < 0xFF) { + + // Retrieve each of the RGB colors + color = g_notification.color & 0x00FFFFFF; + rgb[0] = (color >> 16) & 0xFF; + rgb[1] = (color >> 8) & 0xFF; + rgb[2] = color & 0xFF; + + // Apply the brightness level + if (rgb[0] > 0) + rgb[0] = (rgb[0] * brightness) / 0xFF; + if (rgb[1] > 0) + rgb[1] = (rgb[1] * brightness) / 0xFF; + if (rgb[2] > 0) + rgb[2] = (rgb[2] * brightness) / 0xFF; + + // Update with the new color + g_notification.color = (rgb[0] << 16) + (rgb[1] << 8) + rgb[2]; + } + handle_speaker_light_locked(dev); pthread_mutex_unlock(&g_lock); return 0; } -static int set_light_attention(struct light_device_t* dev, +static int +set_light_attention(struct light_device_t* dev, struct light_state_t const* state) { pthread_mutex_lock(&g_lock); @@ -232,7 +269,8 @@ static int set_light_attention(struct light_device_t* dev, } /** Close the lights device */ -static int close_lights(struct light_device_t *dev) +static int +close_lights(struct light_device_t *dev) { if (dev) { free(dev); @@ -241,8 +279,10 @@ static int close_lights(struct light_device_t *dev) } +/******************************************************************************/ + /** - * Module methods + * module methods */ /** Open a new instance of a lights device using name */