liblight/lights.c - device/sony/lt26 - Git at Google

 /*
  * 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_TAG "lights.lt26"

 #include <cutils/log.h>
 #include <stdint.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;

 	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,
 };
	/*
	* 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_TAG "lights.lt26"

	#include <cutils/log.h>
	#include <stdint.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;

	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,
	};