led: implement led HAL

- Just camera led (flash) located at the back of the target
  is handled currently.

Change-Id: I43aef2c3757be5a02d27d1fecccc2cf50623e044
Signed-off-by: Taeyoung Kim <ty317.kim@samsung.com>

diff --git a/hw/led/led.c b/hw/led/led.c
index a2df95a..56c7c02 100644 (file)
--- a/hw/led/led.c
+++ b/hw/led/led.c
@@ -26,14 +26,99 @@
 #include <hw/led.h>
 #include "../shared.h"
 
+#ifndef CAMERA_BACK_PATH
+#define CAMERA_BACK_PATH    "/sys/class/leds/torch-sec1"
+#endif
+
+static int camera_back_set_state(struct led_state *state)
+{
+       static int max = -1;
+       int brt, r;
+
+       if (!state) {
+               _E("wrong parameter");
+               return -EINVAL;
+       }
+
+       if (state->type == LED_TYPE_BLINK) {
+               _E("camera back led does not support LED_TYPE_BLINK mode");
+               return -ENOTSUP;
+       }
+
+       if (max < 0) {
+               r = sys_get_int(CAMERA_BACK_PATH"/max_brightness", &max);
+               if (r < 0) {
+                       _E("fail to get max brightness (errno:%d)", r);
+                       return r;
+               }
+       }
+
+       brt = (state->color >> 24) & 0xFF;
+       brt = brt / 255.f * max;
+
+       r = sys_set_int(CAMERA_BACK_PATH"/brightness", brt);
+       if (r < 0) {
+               _E("fail to set brightness (errno:%d)", r);
+               return r;
+       }
+
+       return 0;
+}
+
+struct led_device camera_back_dev = {
+       .set_state = camera_back_set_state,
+};
+
+struct led_device_list {
+       const char *id;
+       struct led_device *operations;
+       struct led_device *dev;
+} led_list[] = {
+       { LED_ID_CAMERA_BACK,  &camera_back_dev,  NULL },
+       { LED_ID_CAMERA_FRONT, NULL,              NULL },
+       { LED_ID_NOTIFICATION, NULL,              NULL },
+       { LED_ID_TOUCH_KEY,    NULL,              NULL },
+};
+
 static int led_open(struct hw_info *info,
                const char *id, struct hw_common **common)
 {
+       int i, list_len, id_len;
+
+       if (!info || !id || !common)
+               return -EINVAL;
+
+       list_len = ARRAY_SIZE(led_list);
+       id_len = strlen(id) + 1;
+       for (i = 0 ; i < list_len ; i++) {
+               if (strncmp(id, led_list[i].id, id_len))
+                       continue;
+               if (!led_list[i].operations)
+                       return -ENOTSUP;
+               if (led_list[i].dev)
+                       goto out;
+               break;
+       }
+
+       led_list[i].dev = calloc(1, sizeof(struct led_device));
+       if (!led_list[i].dev)
+               return -ENOMEM;
+
+       led_list[i].dev->common.info = info;
+       led_list[i].dev->set_state
+               = led_list[i].operations->set_state;
+
+out:
+       *common = (struct hw_common *)led_list[i].dev;
        return 0;
 }
 
 static int led_close(struct hw_common *common)
 {
+       if (!common)
+               return -EINVAL;
+
+       free(common);
        return 0;
 }