Initial Replicant 4.2 commit

Many thanks to Lukas Märdian for his great work:
part of the changes introduced in this commit reflect his work.

Signed-off-by: Paul Kocialkowski <contact@paulk.fr>

2 files changed, 303 insertions, 0 deletions

diff --git a/lights/Android.mk b/lights/Android.mk
new file mode 100644
index 0000000..9dc66f6
--- /dev/null
+++ b/lights/Android.mk
@@ -0,0 +1,27 @@
+# Copyright (C) 2012-2014 Paul Kocialkowski <contact@paulk.fr>
+#
+# 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.
+
+LOCAL_PATH:= $(call my-dir)
+include $(CLEAR_VARS)
+
+LOCAL_SRC_FILES := lights.c
+
+LOCAL_SHARED_LIBRARIES := liblog
+
+LOCAL_PRELINK_MODULE := false
+LOCAL_MODULE_PATH := $(TARGET_OUT_SHARED_LIBRARIES)/hw
+LOCAL_MODULE_TAGS := optional
+
+LOCAL_MODULE := lights.gta04
+include $(BUILD_SHARED_LIBRARY)
diff --git a/lights/lights.c b/lights/lights.c
new file mode 100644
index 0000000..418c5ef
--- /dev/null
+++ b/lights/lights.c
@@ -0,0 +1,276 @@
+/*
+ * Copyright (C) 2012-2014 Paul Kocialkowski <contact@paulk.fr>
+ * 
+ * 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.
+ */
+
+#include <stdlib.h>
+#include <stdint.h>
+#include <string.h>
+#include <errno.h>
+#include <fcntl.h>
+#include <pthread.h>
+#include <sys/ioctl.h>
+#include <sys/types.h>
+
+#define LOG_TAG "lights"
+#include <cutils/log.h>
+#include <hardware/lights.h>
+
+/*
+ * Globals
+ */
+
+const char backlight_brightness[] =
+	"/sys/class/backlight/pwm-backlight/brightness";
+const char backlight_max_brightness[] =
+	"/sys/class/backlight/pwm-backlight/max_brightness";
+
+const char battery_red_brightness[] =
+	"/sys/class/leds/gta04:red:power/brightness";
+const char battery_red_max_brightness[] =
+	"/sys/class/leds/gta04:red:power/max_brightness";
+const char battery_green_brightness[] =
+	"/sys/class/leds/gta04:green:power/brightness";
+const char battery_green_max_brightness[] =
+	"/sys/class/leds/gta04:green:power/max_brightness";
+
+const char notifications_red_brightness[] =
+	"/sys/class/leds/gta04:red:aux/brightness";
+const char notifications_red_max_brightness[] =
+	"/sys/class/leds/gta04:red:aux/max_brightness";
+const char notifications_green_brightness[] =
+	"/sys/class/leds/gta04:green:aux/brightness";
+const char notifications_green_max_brightness[] =
+	"/sys/class/leds/gta04:green:aux/max_brightness";
+
+pthread_mutex_t lights_mutex = PTHREAD_MUTEX_INITIALIZER;
+
+/*
+ * Sysfs
+ */
+
+int sysfs_value_read(const char *path)
+{
+    char buffer[100];
+    int value;
+    int fd = -1;
+    int rc;
+
+    if (path == NULL)
+        return -1;
+
+    fd = open(path, O_RDONLY);
+    if (fd < 0)
+        goto error;
+
+    rc = read(fd, &buffer, sizeof(buffer));
+    if (rc <= 0)
+        goto error;
+
+    value = atoi(buffer);
+    goto complete;
+
+error:
+    value = -1;
+
+complete:
+    if (fd >= 0)
+        close(fd);
+
+    return value;
+}
+
+int sysfs_value_write(const char *path, int value)
+{
+    char buffer[100];
+    int fd = -1;
+    int rc;
+
+    if (path == NULL)
+        return -1;
+
+    fd = open(path, O_WRONLY);
+    if (fd < 0)
+        goto error;
+
+    snprintf((char *) &buffer, sizeof(buffer), "%d\n", value);
+
+    rc = write(fd, buffer, strlen(buffer));
+    if (rc < (int) strlen(buffer))
+        goto error;
+
+    rc = 0;
+    goto complete;
+
+error:
+    rc = -1;
+
+complete:
+    if (fd >= 0)
+        close(fd);
+
+    return rc;
+}
+
+/*
+ * Lights
+ */
+
+int set_light_notifications(struct light_device_t *dev,
+	const struct light_state_t *state)
+{
+	int red, green;
+	int max;
+	int rc = 0;
+
+	// GTA04 only has red and green
+	red = state->color & 0x00ff0000;
+	green = state->color & 0x0000ff00;
+
+	pthread_mutex_lock(&lights_mutex);
+
+	// Red max
+	max = sysfs_value_read(notifications_red_max_brightness);
+	if(max > 0)
+		red = (red * max) / 0xff;
+
+	// Green max
+	max = sysfs_value_read(notifications_green_max_brightness);
+	if(max > 0)
+		green = (green * max) / 0xff;
+
+	rc |= sysfs_value_write(notifications_red_brightness, red);
+	rc |= sysfs_value_write(notifications_green_brightness, green);
+
+	pthread_mutex_unlock(&lights_mutex);
+
+	return rc;
+}
+
+int set_light_battery(struct light_device_t *dev,
+	const struct light_state_t *state)
+{
+	int red, green;
+	int max;
+	int rc = 0;
+
+	// GTA04 only has red and green
+	red = state->color & 0x00ff0000;
+	green = state->color & 0x0000ff00;
+
+	pthread_mutex_lock(&lights_mutex);
+
+	// Red max
+	max = sysfs_value_read(battery_red_max_brightness);
+	if(max > 0)
+		red = (red * max) / 0xff;
+
+	// Green max
+	max = sysfs_value_read(battery_green_max_brightness);
+	if(max > 0)
+		green = (green * max) / 0xff;
+
+	rc |= sysfs_value_write(battery_red_brightness, red);
+	rc |= sysfs_value_write(battery_green_brightness, green);
+
+	pthread_mutex_unlock(&lights_mutex);
+
+	return rc;
+}
+
+int set_light_backlight(struct light_device_t *dev,
+	const struct light_state_t *state)
+{
+	int brightness;
+	int color;
+	int max;
+	int rc;
+
+	pthread_mutex_lock(&lights_mutex);
+
+	color = state->color & 0x00ffffff;
+	brightness = ((77 * ((color >> 16) & 0xff)) + (150 * ((color >> 8) & 0xff)) + (29 * (color & 0xff))) >> 8;
+
+	// Brightness max
+	max = sysfs_value_read(backlight_max_brightness);
+	if(max > 0)
+		brightness = (brightness * max) / 0xff;
+
+	rc = sysfs_value_write(backlight_brightness, brightness);
+
+	pthread_mutex_unlock(&lights_mutex);
+
+	return rc;
+}
+
+/*
+ * Interface
+ */
+
+int close_lights(struct light_device_t *dev)
+{
+	ALOGD("%s()", __func__);
+
+	if(dev != NULL)
+		free(dev);
+
+	return 0;
+}
+
+int open_lights(const struct hw_module_t *module, char const *name,
+	struct hw_device_t **device)
+{
+	struct light_device_t *dev = NULL;
+	int (*set_light)(struct light_device_t *dev,
+		const struct light_state_t *state);
+
+	ALOGD("%s(%s)", __func__, name);
+
+	if(strcmp(LIGHT_ID_BACKLIGHT, name) == 0) {
+		set_light = set_light_backlight;
+	} else if(strcmp(LIGHT_ID_BATTERY, name) == 0) {
+		set_light = set_light_battery;
+	} else if(strcmp(LIGHT_ID_NOTIFICATIONS, name) == 0) {
+		set_light = set_light_notifications;
+	} else {
+		return -1;
+	}
+
+	pthread_mutex_init(&lights_mutex, NULL);
+
+	dev = (struct light_device_t *) calloc(1, sizeof(struct light_device_t));
+	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;
+}
+
+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 = "Goldelico GTA04 lights",
+	.author = "Paul Kocialkowski",
+	.methods = &lights_module_methods,
+};