Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- /*
- * Copyright (C) 2008 The Android Open Source Project
- * Copyright (C) 2011 Diogo Ferreira <defer@cyanogenmod.com>
- * Copyright (C) 2012 Andreas Makris <andreas.makris@gmail.com>
- * Copyright (C) 2012 The CyanogenMod Project <http://www.cyanogenmod.com>
- *
- * 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_NDEBUG 0
- #include <cutils/log.h>
- #include <stdint.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>
- #include "lights.h"
- /* Synchronization primities */
- static pthread_once_t g_init = PTHREAD_ONCE_INIT;
- static pthread_mutex_t g_lock = PTHREAD_MUTEX_INITIALIZER;
- /* Mini-led state machine */
- static struct light_state_t g_notification;
- static struct light_state_t g_battery;
- static int g_backlight = 255;
- /* The leds we have */
- enum {
- LED_RED,
- LED_GREEN,
- LED_BLUE,
- LED_BLANK
- };
- enum {
- MANUAL = 0,
- AUTOMATIC,
- MANUAL_SENSOR
- };
- static int write_int (const char *path, int value) {
- int fd;
- static int already_warned = 0;
- fd = open(path, O_RDWR);
- if (fd < 0) {
- if (already_warned == 0) {
- ALOGE("write_int failed to open %s\n", path);
- already_warned = 1;
- }
- return -errno;
- }
- char buffer[20];
- int bytes = snprintf(buffer, sizeof(buffer), "%d\n", value);
- int written = write (fd, buffer, bytes);
- close(fd);
- return written == -1 ? -errno : 0;
- }
- static int write_string (const char *path, const char *value) {
- int fd;
- static int already_warned = 0;
- fd = open(path, O_RDWR);
- if (fd < 0) {
- if (already_warned == 0) {
- ALOGE("write_string failed to open %s\n", path);
- already_warned = 1;
- }
- return -errno;
- }
- char buffer[20];
- int bytes = snprintf(buffer, sizeof(buffer), "%s\n", value);
- int written = write (fd, buffer, bytes);
- close(fd);
- return written == -1 ? -errno : 0;
- }
- /* Color tools */
- 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) {
- int color = state->color & 0x00ffffff;
- return ((77*((color>>16)&0x00ff))
- + (150*((color>>8)&0x00ff)) + (29*(color&0x00ff))) >> 8;
- }
- /* The actual lights controlling section */
- static int set_light_backlight (struct light_device_t *dev, struct light_state_t const *state) {
- int brightness = rgb_to_brightness(state);
- int als_mode;
- switch (state->brightnessMode) {
- case BRIGHTNESS_MODE_SENSOR:
- als_mode = AUTOMATIC;
- break;
- case BRIGHTNESS_MODE_USER:
- als_mode = BRIGHTNESS_MODE_USER;
- break;
- default:
- als_mode = MANUAL_SENSOR;
- break;
- }
- ALOGV("%s brightness=%d color=0x%08x", __func__,brightness,state->color);
- pthread_mutex_lock(&g_lock);
- g_backlight = brightness;
- write_int (ALS_FILE, als_mode);
- write_int (LCD_BACKLIGHT_FILE, brightness);
- pthread_mutex_unlock(&g_lock);
- return 0;
- }
- static int set_light_buttons (struct light_device_t *dev, struct light_state_t const* state) {
- size_t i;
- int on = is_lit(state);
- pthread_mutex_lock(&g_lock);
- for (i = 0; i < sizeof(BUTTON_BACKLIGHT_FILE)/sizeof(BUTTON_BACKLIGHT_FILE[0]); i++) {
- write_int (BUTTON_BACKLIGHT_FILE[i],on?255:0);
- }
- pthread_mutex_unlock(&g_lock);
- return 0;
- }
- static void set_shared_light_locked (struct light_device_t *dev, struct light_state_t *state) {
- int r, g, b;
- int delayOn,delayOff;
- r = (state->color >> 16) & 0xFF;
- g = (state->color >> 8) & 0xFF;
- b = (state->color) & 0xFF;
- delayOn = state->flashOnMS;
- delayOff = state->flashOffMS;
- ALOGV("set_shared_light_lock, R: %d, G: %d, B: %d, color=0x%08x", r, g, b, state->color);
- if (state->flashMode != LIGHT_FLASH_NONE) {
- write_string (RED_LED_FILE_TRIGGER, "timer");
- write_string (GREEN_LED_FILE_TRIGGER, "timer");
- write_string (BLUE_LED_FILE_TRIGGER, "timer");
- write_int (RED_LED_FILE_DELAYON, delayOn);
- write_int (GREEN_LED_FILE_DELAYON, delayOn);
- write_int (BLUE_LED_FILE_DELAYON, delayOn);
- write_int (RED_LED_FILE_DELAYOFF, delayOff);
- write_int (GREEN_LED_FILE_DELAYOFF, delayOff);
- write_int (BLUE_LED_FILE_DELAYOFF, delayOff);
- } else {
- write_string (RED_LED_FILE_TRIGGER, "none");
- write_string (GREEN_LED_FILE_TRIGGER, "none");
- write_string (BLUE_LED_FILE_TRIGGER, "none");
- }
- write_int (RED_LED_FILE, r);
- write_int (GREEN_LED_FILE, g);
- write_int (BLUE_LED_FILE, b);
- }
- static void handle_shared_battery_locked (struct light_device_t *dev) {
- if (is_lit (&g_notification)) {
- set_shared_light_locked (dev, &g_notification);
- } else {
- set_shared_light_locked (dev, &g_battery);
- }
- }
- static int set_light_battery (struct light_device_t *dev, struct light_state_t const* state) {
- pthread_mutex_lock (&g_lock);
- g_battery = *state;
- handle_shared_battery_locked(dev);
- pthread_mutex_unlock (&g_lock);
- return 0;
- }
- static int set_light_notifications (struct light_device_t *dev, struct light_state_t const* state) {
- pthread_mutex_lock (&g_lock);
- g_notification = *state;
- handle_shared_battery_locked(dev);
- pthread_mutex_unlock (&g_lock);
- return 0;
- }
- /* Initializations */
- void init_globals () {
- pthread_mutex_init (&g_lock, NULL);
- }
- /* Glueing boilerplate */
- static int close_lights (struct light_device_t *dev) {
- if (dev)
- free(dev);
- return 0;
- }
- 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_battery;
- }
- else if (0 == strcmp(LIGHT_ID_NOTIFICATIONS, name)) {
- set_light = set_light_notifications;
- }
- else {
- return -EINVAL;
- }
- pthread_once (&g_init, init_globals);
- 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 = "Sony lights module",
- .author = "Diogo Ferreira <defer@cyanogenmod.com>, Andreas Makris <Andreas.Makris@gmail.com>",
- .methods = &lights_module_methods,
- };
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement