LED: Add LED HAL to light module

adding LED HAL for an30259a device
The device file is /dev/an30259a_leds.

Change-Id: I071d081cde05f2b8626992f3831f55be09fddce5
Signed-off-by: Won Hyoung Lee <whlee@sta.samsung.com>
Signed-off-by: Mike Lockwood <lockwood@android.com>

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));