From 0a0fb780b63fbf86341f669cfa90d1d51c5789f6 Mon Sep 17 00:00:00 2001 From: LuK1337 Date: Wed, 28 Mar 2018 14:58:11 +0200 Subject: [PATCH] kitakami-common: Import light HAL * Remove legacy liblights HAL. --- Android.bp | 3 + device-common.mk | 3 +- liblights/Android.mk | 33 -- liblights/lights.c | 497 ------------------ light/Android.bp | 32 ++ light/Light.cpp | 281 ++++++++++ light/Light.h | 94 ++++ ...oid.hardware.light@2.0-service.kitakami.rc | 41 ++ light/service.cpp | 256 +++++++++ 9 files changed, 708 insertions(+), 532 deletions(-) create mode 100644 Android.bp delete mode 100644 liblights/Android.mk delete mode 100644 liblights/lights.c create mode 100644 light/Android.bp create mode 100644 light/Light.cpp create mode 100644 light/Light.h create mode 100644 light/android.hardware.light@2.0-service.kitakami.rc create mode 100644 light/service.cpp diff --git a/Android.bp b/Android.bp new file mode 100644 index 0000000..f61e31b --- /dev/null +++ b/Android.bp @@ -0,0 +1,3 @@ +subdirs = [ + "light", +] diff --git a/device-common.mk b/device-common.mk index e84179f..f95a75f 100644 --- a/device-common.mk +++ b/device-common.mk @@ -181,8 +181,7 @@ PRODUCT_PACKAGES += \ # Lights PRODUCT_PACKAGES += \ - android.hardware.light@2.0-impl \ - lights.msm8994 + android.hardware.light@2.0-service.kitakami # Media PRODUCT_PACKAGES += \ diff --git a/liblights/Android.mk b/liblights/Android.mk deleted file mode 100644 index 53c4e63..0000000 --- a/liblights/Android.mk +++ /dev/null @@ -1,33 +0,0 @@ -# Copyright (C) 2008 The Android Open Source Project -# -# 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) - -ifeq ($(TARGET_HAS_LOW_PERSISTENCE_DISPLAY),true) - LOCAL_CFLAGS += -DLOW_PERSISTENCE_DISPLAY -endif - -ifeq ($(TARGET_COMPILE_WITH_MSM_KERNEL),true) -LOCAL_C_INCLUDES += $(TARGET_OUT_INTERMEDIATES)/KERNEL_OBJ/usr/include -LOCAL_ADDITIONAL_DEPENDENCIES := $(TARGET_OUT_INTERMEDIATES)/KERNEL_OBJ/usr -endif - -LOCAL_SRC_FILES := lights.c -LOCAL_SHARED_LIBRARIES := liblog -LOCAL_MODULE := lights.$(TARGET_BOARD_PLATFORM) -LOCAL_MODULE_TAGS := optional -LOCAL_MODULE_RELATIVE_PATH := hw -include $(BUILD_SHARED_LIBRARY) diff --git a/liblights/lights.c b/liblights/lights.c deleted file mode 100644 index 8da158b..0000000 --- a/liblights/lights.c +++ /dev/null @@ -1,497 +0,0 @@ -/* - * Copyright (C) 2016 The CyanogenMod Project - * Copyright (C) 2017 The LineageOS Project - * - * 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" - -#include - -#include -#include -#include -#include -#include -#include -#include - -#include -#include - -#include - -/******************************************************************************/ - -static pthread_once_t g_init = PTHREAD_ONCE_INIT; -static pthread_mutex_t g_lock = PTHREAD_MUTEX_INITIALIZER; -static struct light_state_t g_attention; -static struct light_state_t g_notification; -static struct light_state_t g_battery; -static short backlight_bits = 8; - -char const*const RED_LED_FILE - = "/sys/class/leds/red/brightness"; - -char const*const GREEN_LED_FILE - = "/sys/class/leds/green/brightness"; - -char const*const BLUE_LED_FILE - = "/sys/class/leds/blue/brightness"; - -char const*const LCD_FILE - = "/sys/class/leds/lcd-backlight/brightness"; - -char const*const LCD_MAX_FILE - = "/sys/class/leds/lcd-backlight/max_brightness"; - -char const*const RED_DUTY_PCTS_FILE - = "/sys/class/leds/red/duty_pcts"; - -char const*const GREEN_DUTY_PCTS_FILE - = "/sys/class/leds/green/duty_pcts"; - -char const*const BLUE_DUTY_PCTS_FILE - = "/sys/class/leds/blue/duty_pcts"; - -char const*const RED_START_IDX_FILE - = "/sys/class/leds/red/start_idx"; - -char const*const GREEN_START_IDX_FILE - = "/sys/class/leds/green/start_idx"; - -char const*const BLUE_START_IDX_FILE - = "/sys/class/leds/blue/start_idx"; - -char const*const RED_PAUSE_LO_FILE - = "/sys/class/leds/red/pause_lo"; - -char const*const GREEN_PAUSE_LO_FILE - = "/sys/class/leds/green/pause_lo"; - -char const*const BLUE_PAUSE_LO_FILE - = "/sys/class/leds/blue/pause_lo"; - -char const*const RED_PAUSE_HI_FILE - = "/sys/class/leds/red/pause_hi"; - -char const*const GREEN_PAUSE_HI_FILE - = "/sys/class/leds/green/pause_hi"; - -char const*const BLUE_PAUSE_HI_FILE - = "/sys/class/leds/blue/pause_hi"; - -char const*const RED_RAMP_STEP_MS_FILE - = "/sys/class/leds/red/ramp_step_ms"; - -char const*const GREEN_RAMP_STEP_MS_FILE - = "/sys/class/leds/green/ramp_step_ms"; - -char const*const BLUE_RAMP_STEP_MS_FILE - = "/sys/class/leds/blue/ramp_step_ms"; - -char const*const RED_BLINK_FILE - = "/sys/class/leds/red/blink"; - -char const*const GREEN_BLINK_FILE - = "/sys/class/leds/green/blink"; - -char const*const BLUE_BLINK_FILE - = "/sys/class/leds/blue/blink"; - -#define RAMP_SIZE 8 -static int BRIGHTNESS_RAMP[RAMP_SIZE] - = { 0, 12, 25, 37, 50, 72, 85, 100 }; -#define RAMP_STEP_DURATION 50 - -/** - * device methods - */ - -static int -read_int(char const* path) -{ - static int already_warned = 0; - int fd; - - fd = open(path, O_RDONLY); - if (fd >= 0) { - char read_str[10] = {0,0,0,0,0,0,0,0,0,0}; - ssize_t err = read(fd, &read_str, sizeof(read_str)); - close(fd); - return err < 2 ? -errno : atoi(read_str); - } else { - if (already_warned == 0) { - ALOGE("read_int failed to open %s\n", path); - already_warned = 1; - } - return -errno; - }; -} - -void init_globals(void) -{ - // init the mutex - pthread_mutex_init(&g_lock, NULL); - backlight_bits = (read_int(LCD_MAX_FILE) == 4095 ? 12 : 8); - -} - -static int -write_int(char const* path, int value) -{ - int fd; - static int already_warned = 0; - - fd = open(path, O_RDWR); - if (fd >= 0) { - char buffer[20]; - int bytes = snprintf(buffer, sizeof(buffer), "%d\n", value); - ssize_t amt = write(fd, buffer, (size_t)bytes); - close(fd); - return amt == -1 ? -errno : 0; - } else { - if (already_warned == 0) { - ALOGE("write_int failed to open %s\n", path); - already_warned = 1; - } - return -errno; - } -} - -static int -write_str(char const* path, char* value) -{ - int fd; - static int already_warned = 0; - - fd = open(path, O_RDWR); - if (fd >= 0) { - char buffer[1024]; - int bytes = snprintf(buffer, sizeof(buffer), "%s\n", value); - ssize_t amt = write(fd, buffer, (size_t)bytes); - close(fd); - return amt == -1 ? -errno : 0; - } else { - if (already_warned == 0) { - ALOGE("write_int failed to open %s\n", path); - already_warned = 1; - } - return -errno; - } -} - -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; -} - -static int -set_light_backlight(struct light_device_t* dev, - struct light_state_t const* state) -{ - int err = 0; - int brightness = rgb_to_brightness(state); - unsigned int lpEnabled = state->brightnessMode == BRIGHTNESS_MODE_LOW_PERSISTENCE; - - if(!dev) { - return -1; - } - - pthread_mutex_lock(&g_lock); - - if (!err) { - if (backlight_bits > 8) - brightness = brightness << (backlight_bits - 8); - - err = write_int(LCD_FILE, brightness); - } - - pthread_mutex_unlock(&g_lock); - return err; -} - - - -static char* -get_scaled_duty_pcts(int brightness) -{ - char *buf = malloc(5 * RAMP_SIZE * sizeof(char)); - char *pad = ""; - int i = 0; - - memset(buf, 0, 5 * RAMP_SIZE * sizeof(char)); - - for (i = 0; i < RAMP_SIZE; i++) { - char temp[5] = ""; - snprintf(temp, sizeof(temp), "%s%d", pad, (BRIGHTNESS_RAMP[i] * brightness / 255)); - strcat(buf, temp); - pad = ","; - } - ALOGV("%s: brightness=%d duty=%s", __func__, brightness, buf); - return buf; -} - -static int -set_speaker_light_locked(struct light_device_t* dev, - struct light_state_t const* state) -{ - int red, green, blue, blink; - int onMS, offMS, stepDuration, pauseHi; - unsigned int colorRGB; - char *duty; - - if(!dev) { - return -1; - } - - switch (state->flashMode) { - case LIGHT_FLASH_TIMED: - onMS = state->flashOnMS; - offMS = state->flashOffMS; - break; - case LIGHT_FLASH_NONE: - default: - onMS = 0; - offMS = 0; - break; - } - - colorRGB = state->color; - - ALOGV("set_speaker_light_locked mode %d, colorRGB=%08X, onMS=%d, offMS=%d\n", - state->flashMode, colorRGB, onMS, offMS); - - red = (colorRGB >> 16) & 0xFF; - green = (colorRGB >> 8) & 0xFF; - blue = colorRGB & 0xFF; - // bias for true white - if (colorRGB != 0 && red == green && green == blue) { - blue = (blue * 171) / 256; - } - blink = onMS > 0 && offMS > 0; - - // disable all blinking to start - write_int(RED_BLINK_FILE, 0); - write_int(GREEN_BLINK_FILE, 0); - write_int(BLUE_BLINK_FILE, 0); - - if (blink) { - stepDuration = RAMP_STEP_DURATION; - pauseHi = onMS - (stepDuration * RAMP_SIZE * 2); - if (stepDuration * RAMP_SIZE * 2 > onMS) { - stepDuration = onMS / (RAMP_SIZE * 2); - pauseHi = 0; - } - - // red - write_int(RED_START_IDX_FILE, 0); - duty = get_scaled_duty_pcts(red); - write_str(RED_DUTY_PCTS_FILE, duty); - write_int(RED_PAUSE_LO_FILE, offMS); - // The led driver is configured to ramp up then ramp - // down the lut. This effectively doubles the ramp duration. - write_int(RED_PAUSE_HI_FILE, pauseHi); - write_int(RED_RAMP_STEP_MS_FILE, stepDuration); - free(duty); - - // green - write_int(GREEN_START_IDX_FILE, RAMP_SIZE); - duty = get_scaled_duty_pcts(green); - write_str(GREEN_DUTY_PCTS_FILE, duty); - write_int(GREEN_PAUSE_LO_FILE, offMS); - // The led driver is configured to ramp up then ramp - // down the lut. This effectively doubles the ramp duration. - write_int(GREEN_PAUSE_HI_FILE, pauseHi); - write_int(GREEN_RAMP_STEP_MS_FILE, stepDuration); - free(duty); - - // blue - write_int(BLUE_START_IDX_FILE, RAMP_SIZE * 2); - duty = get_scaled_duty_pcts(blue); - write_str(BLUE_DUTY_PCTS_FILE, duty); - write_int(BLUE_PAUSE_LO_FILE, offMS); - // The led driver is configured to ramp up then ramp - // down the lut. This effectively doubles the ramp duration. - write_int(BLUE_PAUSE_HI_FILE, pauseHi); - write_int(BLUE_RAMP_STEP_MS_FILE, stepDuration); - free(duty); - - // start the party - write_int(RED_BLINK_FILE, red); - write_int(GREEN_BLINK_FILE, green); - write_int(BLUE_BLINK_FILE, blue); - - } else { - write_int(RED_LED_FILE, red); - write_int(GREEN_LED_FILE, green); - write_int(BLUE_LED_FILE, blue); - } - - - return 0; -} - -static void -handle_speaker_light_locked(struct light_device_t* dev) -{ - if (is_lit(&g_attention)) { - set_speaker_light_locked(dev, &g_attention); - } else if (is_lit(&g_notification)) { - set_speaker_light_locked(dev, &g_notification); - } else { - set_speaker_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_speaker_light_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); - - unsigned int brightness; - unsigned int color; - unsigned int rgb[3]; - - g_notification = *state; - - // If a brightness has been applied by the user - brightness = (g_notification.color & 0xFF000000) >> 24; - if (brightness > 0 && brightness < 0xFF) { - - // Retrieve each of the RGB colors - color = g_notification.color & 0x00FFFFFF; - rgb[0] = (color >> 16) & 0xFF; - rgb[1] = (color >> 8) & 0xFF; - rgb[2] = color & 0xFF; - - // Apply the brightness level - if (rgb[0] > 0) - rgb[0] = (rgb[0] * brightness) / 0xFF; - if (rgb[1] > 0) - rgb[1] = (rgb[1] * brightness) / 0xFF; - if (rgb[2] > 0) - rgb[2] = (rgb[2] * brightness) / 0xFF; - - // Update with the new color - g_notification.color = (rgb[0] << 16) + (rgb[1] << 8) + rgb[2]; - } - - handle_speaker_light_locked(dev); - pthread_mutex_unlock(&g_lock); - return 0; -} - -static int -set_light_attention(struct light_device_t* dev, - struct light_state_t const* state) -{ - pthread_mutex_lock(&g_lock); - g_attention = *state; - handle_speaker_light_locked(dev); - pthread_mutex_unlock(&g_lock); - return 0; -} - -/** Close the lights device */ -static int -close_lights(struct light_device_t *dev) -{ - if (dev) { - free(dev); - } - return 0; -} - - -/******************************************************************************/ - -/** - * module methods - */ - -/** Open a new instance of a lights device using name */ -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_BATTERY, name)) - set_light = set_light_battery; - else if (0 == strcmp(LIGHT_ID_NOTIFICATIONS, name)) - set_light = set_light_notifications; - else if (0 == strcmp(LIGHT_ID_ATTENTION, name)) - set_light = set_light_attention; - else - return -EINVAL; - - pthread_once(&g_init, init_globals); - - struct light_device_t *dev = malloc(sizeof(struct light_device_t)); - - if(!dev) - return -ENOMEM; - - 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, -}; - -/* - * The lights Module - */ -struct hw_module_t HAL_MODULE_INFO_SYM = { - .tag = HARDWARE_MODULE_TAG, - .version_major = 1, - .version_minor = 0, - .id = LIGHTS_HARDWARE_MODULE_ID, - .name = "Lights Module", - .author = "The LineageOS Project", - .methods = &lights_module_methods, -}; diff --git a/light/Android.bp b/light/Android.bp new file mode 100644 index 0000000..1e772af --- /dev/null +++ b/light/Android.bp @@ -0,0 +1,32 @@ +// +// Copyright (C) 2018 The LineageOS Project +// +// 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. + +cc_binary { + name: "android.hardware.light@2.0-service.kitakami", + relative_install_path: "hw", + init_rc: ["android.hardware.light@2.0-service.kitakami.rc"], + srcs: ["service.cpp", "Light.cpp"], + shared_libs: [ + "libbase", + "libcutils", + "libhardware", + "libhidlbase", + "libhidltransport", + "libhwbinder", + "libutils", + "android.hardware.light@2.0", + ], + proprietary: true, +} diff --git a/light/Light.cpp b/light/Light.cpp new file mode 100644 index 0000000..c59abb6 --- /dev/null +++ b/light/Light.cpp @@ -0,0 +1,281 @@ +/* + * Copyright (C) 2018 The LineageOS Project + * + * 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 "LightService" + +#include "Light.h" + +#include + +namespace { +using android::hardware::light::V2_0::LightState; + +static constexpr int RAMP_SIZE = 8; +static constexpr int RAMP_STEP_DURATION = 50; + +static constexpr int BRIGHTNESS_RAMP[RAMP_SIZE] = {0, 12, 25, 37, 50, 72, 85, 100}; +static constexpr int DEFAULT_MAX_BRIGHTNESS = 255; + +static uint32_t rgbToBrightness(const LightState& state) { + uint32_t color = state.color & 0x00ffffff; + return ((77 * ((color >> 16) & 0xff)) + (150 * ((color >> 8) & 0xff)) + + (29 * (color & 0xff))) >> 8; +} + +static bool isLit(const LightState& state) { + return (state.color & 0x00ffffff); +} + +static std::string getScaledDutyPcts(int brightness) { + std::string buf, pad; + + for (auto i : BRIGHTNESS_RAMP) { + buf += pad; + buf += std::to_string(i * brightness / 255); + pad = ","; + } + + return buf; +} +} // anonymous namespace + +namespace android { +namespace hardware { +namespace light { +namespace V2_0 { +namespace implementation { + +Light::Light(std::pair&& lcd_backlight, + std::ofstream&& red_led, std::ofstream&& green_led, std::ofstream&& blue_led, + std::ofstream&& red_duty_pcts, std::ofstream&& green_duty_pcts, std::ofstream&& blue_duty_pcts, + std::ofstream&& red_start_idx, std::ofstream&& green_start_idx, std::ofstream&& blue_start_idx, + std::ofstream&& red_pause_lo, std::ofstream&& green_pause_lo, std::ofstream&& blue_pause_lo, + std::ofstream&& red_pause_hi, std::ofstream&& green_pause_hi, std::ofstream&& blue_pause_hi, + std::ofstream&& red_ramp_step_ms, std::ofstream&& green_ramp_step_ms, std::ofstream&& blue_ramp_step_ms, + std::ofstream&& red_blink, std::ofstream&& green_blink, std::ofstream&& blue_blink, + std::ofstream&& rgb_blink) + : mLcdBacklight(std::move(lcd_backlight)), + mRedLed(std::move(red_led)), + mGreenLed(std::move(green_led)), + mBlueLed(std::move(blue_led)), + mRedDutyPcts(std::move(red_duty_pcts)), + mGreenDutyPcts(std::move(green_duty_pcts)), + mBlueDutyPcts(std::move(blue_duty_pcts)), + mRedStartIdx(std::move(red_start_idx)), + mGreenStartIdx(std::move(green_start_idx)), + mBlueStartIdx(std::move(blue_start_idx)), + mRedPauseLo(std::move(red_pause_lo)), + mGreenPauseLo(std::move(green_pause_lo)), + mBluePauseLo(std::move(blue_pause_lo)), + mRedPauseHi(std::move(red_pause_hi)), + mGreenPauseHi(std::move(green_pause_hi)), + mBluePauseHi(std::move(blue_pause_hi)), + mRedRampStepMs(std::move(red_ramp_step_ms)), + mGreenRampStepMs(std::move(green_ramp_step_ms)), + mBlueRampStepMs(std::move(blue_ramp_step_ms)), + mRedBlink(std::move(red_blink)), + mGreenBlink(std::move(green_blink)), + mBlueBlink(std::move(blue_blink)), + mRgbBlink(std::move(rgb_blink)) { + auto attnFn(std::bind(&Light::setAttentionLight, this, std::placeholders::_1)); + auto backlightFn(std::bind(&Light::setLcdBacklight, this, std::placeholders::_1)); + auto batteryFn(std::bind(&Light::setBatteryLight, this, std::placeholders::_1)); + auto notifFn(std::bind(&Light::setNotificationLight, this, std::placeholders::_1)); + mLights.emplace(std::make_pair(Type::ATTENTION, attnFn)); + mLights.emplace(std::make_pair(Type::BACKLIGHT, backlightFn)); + mLights.emplace(std::make_pair(Type::BATTERY, batteryFn)); + mLights.emplace(std::make_pair(Type::NOTIFICATIONS, notifFn)); +} + +// Methods from ::android::hardware::light::V2_0::ILight follow. +Return Light::setLight(Type type, const LightState& state) { + auto it = mLights.find(type); + + if (it == mLights.end()) { + return Status::LIGHT_NOT_SUPPORTED; + } + + it->second(state); + + return Status::SUCCESS; +} + +Return Light::getSupportedTypes(getSupportedTypes_cb _hidl_cb) { + std::vector types; + + for (auto const& light : mLights) { + types.push_back(light.first); + } + + _hidl_cb(types); + + return Void(); +} + +void Light::setAttentionLight(const LightState& state) { + std::lock_guard lock(mLock); + mAttentionState = state; + setSpeakerBatteryLightLocked(); +} + +void Light::setLcdBacklight(const LightState& state) { + std::lock_guard lock(mLock); + + uint32_t brightness = rgbToBrightness(state); + + // If max panel brightness is not the default (255), + // apply linear scaling across the accepted range. + if (mLcdBacklight.second != DEFAULT_MAX_BRIGHTNESS) { + int old_brightness = brightness; + brightness = brightness * mLcdBacklight.second / DEFAULT_MAX_BRIGHTNESS; + LOG(VERBOSE) << "scaling brightness " << old_brightness << " => " << brightness; + } + + mLcdBacklight.first << brightness << std::endl; +} + +void Light::setBatteryLight(const LightState& state) { + std::lock_guard lock(mLock); + mBatteryState = state; + setSpeakerBatteryLightLocked(); +} + +void Light::setNotificationLight(const LightState& state) { + std::lock_guard lock(mLock); + + uint32_t brightness, color, rgb[3]; + LightState localState = state; + + // If a brightness has been applied by the user + brightness = (localState.color & 0xff000000) >> 24; + if (brightness > 0 && brightness < 255) { + // Retrieve each of the RGB colors + color = localState.color & 0x00ffffff; + rgb[0] = (color >> 16) & 0xff; + rgb[1] = (color >> 8) & 0xff; + rgb[2] = color & 0xff; + + // Apply the brightness level + if (rgb[0] > 0) { + rgb[0] = (rgb[0] * brightness) / 0xff; + } + if (rgb[1] > 0) { + rgb[1] = (rgb[1] * brightness) / 0xff; + } + if (rgb[2] > 0) { + rgb[2] = (rgb[2] * brightness) / 0xff; + } + + // Update with the new color + localState.color = (rgb[0] << 16) + (rgb[1] << 8) + rgb[2]; + } + + mNotificationState = localState; + setSpeakerBatteryLightLocked(); +} + +void Light::setSpeakerBatteryLightLocked() { + if (isLit(mNotificationState)) { + setSpeakerLightLocked(mNotificationState); + } else if (isLit(mAttentionState)) { + setSpeakerLightLocked(mAttentionState); + } else if (isLit(mBatteryState)) { + setSpeakerLightLocked(mBatteryState); + } else { + // Lights off + mRedLed << 0 << std::endl; + mGreenLed << 0 << std::endl; + mBlueLed << 0 << std::endl; + mRedBlink << 0 << std::endl; + mGreenBlink << 0 << std::endl; + mBlueBlink << 0 << std::endl; + } +} + +void Light::setSpeakerLightLocked(const LightState& state) { + int red, green, blue, blink; + int onMs, offMs, stepDuration, pauseHi; + uint32_t colorRGB = state.color; + + switch (state.flashMode) { + case Flash::TIMED: + onMs = state.flashOnMs; + offMs = state.flashOffMs; + break; + case Flash::NONE: + default: + onMs = 0; + offMs = 0; + break; + } + + red = (colorRGB >> 16) & 0xff; + green = (colorRGB >> 8) & 0xff; + blue = colorRGB & 0xff; + blink = onMs > 0 && offMs > 0; + + // Disable all blinking to start + mRgbBlink << 0 << std::endl; + + if (blink) { + stepDuration = RAMP_STEP_DURATION; + pauseHi = onMs - (stepDuration * RAMP_SIZE * 2); + + if (stepDuration * RAMP_SIZE * 2 > onMs) { + stepDuration = onMs / (RAMP_SIZE * 2); + pauseHi = 0; + } + + // Red + mRedStartIdx << 0 << std::endl; + mRedDutyPcts << getScaledDutyPcts(red) << std::endl; + mRedPauseLo << offMs << std::endl; + mRedPauseHi << pauseHi << std::endl; + mRedRampStepMs << stepDuration << std::endl; + + // Green + mGreenStartIdx << RAMP_SIZE << std::endl; + mGreenDutyPcts << getScaledDutyPcts(green) << std::endl; + mGreenPauseLo << offMs << std::endl; + mGreenPauseHi << pauseHi << std::endl; + mGreenRampStepMs << stepDuration << std::endl; + + // Blue + mBlueStartIdx << RAMP_SIZE * 2 << std::endl; + mBlueDutyPcts << getScaledDutyPcts(blue) << std::endl; + mBluePauseLo << offMs << std::endl; + mBluePauseHi << pauseHi << std::endl; + mBlueRampStepMs << stepDuration << std::endl; + + // Start the party + mRgbBlink << 1 << std::endl; + } else { + if (red == 0 && green == 0 && blue == 0) { + mRedBlink << 0 << std::endl; + mGreenBlink << 0 << std::endl; + mBlueBlink << 0 << std::endl; + } + mRedLed << red << std::endl; + mGreenLed << green << std::endl; + mBlueLed << blue << std::endl; + } +} + +} // namespace implementation +} // namespace V2_0 +} // namespace light +} // namespace hardware +} // namespace android diff --git a/light/Light.h b/light/Light.h new file mode 100644 index 0000000..958d215 --- /dev/null +++ b/light/Light.h @@ -0,0 +1,94 @@ +/* + * Copyright (C) 2018 The LineageOS Project + * + * 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. + */ + +#ifndef ANDROID_HARDWARE_LIGHT_V2_0_LIGHT_H +#define ANDROID_HARDWARE_LIGHT_V2_0_LIGHT_H + +#include +#include + +#include +#include +#include + +namespace android { +namespace hardware { +namespace light { +namespace V2_0 { +namespace implementation { + +struct Light : public ILight { + Light(std::pair&& lcd_backlight, + std::ofstream&& red_led, std::ofstream&& green_led, std::ofstream&& blue_led, + std::ofstream&& red_duty_pcts, std::ofstream&& green_duty_pcts, std::ofstream&& blue_duty_pcts, + std::ofstream&& red_start_idx, std::ofstream&& green_start_idx, std::ofstream&& blue_start_idx, + std::ofstream&& red_pause_lo, std::ofstream&& green_pause_lo, std::ofstream&& blue_pause_lo, + std::ofstream&& red_pause_hi, std::ofstream&& green_pause_hi, std::ofstream&& blue_pause_hi, + std::ofstream&& red_ramp_step_ms, std::ofstream&& green_ramp_step_ms, std::ofstream&& blue_ramp_step_ms, + std::ofstream&& red_blink, std::ofstream&& green_blink, std::ofstream&& blue_blink, + std::ofstream&& rgb_blink); + + // Methods from ::android::hardware::light::V2_0::ILight follow. + Return setLight(Type type, const LightState& state) override; + Return getSupportedTypes(getSupportedTypes_cb _hidl_cb) override; + + private: + void setAttentionLight(const LightState& state); + void setBatteryLight(const LightState& state); + void setLcdBacklight(const LightState& state); + void setNotificationLight(const LightState& state); + void setSpeakerBatteryLightLocked(); + void setSpeakerLightLocked(const LightState& state); + + std::pair mLcdBacklight; + std::ofstream mRedLed; + std::ofstream mGreenLed; + std::ofstream mBlueLed; + std::ofstream mRedDutyPcts; + std::ofstream mGreenDutyPcts; + std::ofstream mBlueDutyPcts; + std::ofstream mRedStartIdx; + std::ofstream mGreenStartIdx; + std::ofstream mBlueStartIdx; + std::ofstream mRedPauseLo; + std::ofstream mGreenPauseLo; + std::ofstream mBluePauseLo; + std::ofstream mRedPauseHi; + std::ofstream mGreenPauseHi; + std::ofstream mBluePauseHi; + std::ofstream mRedRampStepMs; + std::ofstream mGreenRampStepMs; + std::ofstream mBlueRampStepMs; + std::ofstream mRedBlink; + std::ofstream mGreenBlink; + std::ofstream mBlueBlink; + std::ofstream mRgbBlink; + + LightState mAttentionState; + LightState mBatteryState; + LightState mNotificationState; + + std::unordered_map> mLights; + std::mutex mLock; +}; + +} // namespace implementation +} // namespace V2_0 +} // namespace light +} // namespace hardware +} // namespace android + +#endif // ANDROID_HARDWARE_LIGHT_V2_0_LIGHT_H diff --git a/light/android.hardware.light@2.0-service.kitakami.rc b/light/android.hardware.light@2.0-service.kitakami.rc new file mode 100644 index 0000000..d42e240 --- /dev/null +++ b/light/android.hardware.light@2.0-service.kitakami.rc @@ -0,0 +1,41 @@ +on init + # RGB lights + chown system system /sys/class/leds/red/pause_lo + chown system system /sys/class/leds/green/pause_lo + chown system system /sys/class/leds/blue/pause_lo + + chown system system /sys/class/leds/red/pause_hi + chown system system /sys/class/leds/green/pause_hi + chown system system /sys/class/leds/blue/pause_hi + + chown system system /sys/class/leds/red/blink + chown system system /sys/class/leds/green/blink + chown system system /sys/class/leds/blue/blink + + chown system system /sys/class/leds/rgb/rgb_blink + + chown system system /sys/class/leds/red/ramp_step_ms + chown system system /sys/class/leds/green/ramp_step_ms + chown system system /sys/class/leds/blue/ramp_step_ms + chown system system /sys/class/leds/red/duty_pcts + chown system system /sys/class/leds/green/duty_pcts + chown system system /sys/class/leds/blue/duty_pcts + chown system system /sys/class/leds/red/start_idx + chown system system /sys/class/leds/green/start_idx + chown system system /sys/class/leds/blue/start_idx + + chmod 660 /sys/class/leds/red/ramp_step_ms + chmod 660 /sys/class/leds/green/ramp_step_ms + chmod 660 /sys/class/leds/blue/ramp_step_ms + chmod 660 /sys/class/leds/red/duty_pcts + chmod 660 /sys/class/leds/green/duty_pcts + chmod 660 /sys/class/leds/blue/duty_pcts + chmod 660 /sys/class/leds/red/start_idx + chmod 660 /sys/class/leds/green/start_idx + chmod 660 /sys/class/leds/blue/start_idx + chmod 660 /sys/class/leds/rgb/rgb_blink + +service light-hal-2-0 /vendor/bin/hw/android.hardware.light@2.0-service.kitakami + class hal + user system + group system diff --git a/light/service.cpp b/light/service.cpp new file mode 100644 index 0000000..406cb11 --- /dev/null +++ b/light/service.cpp @@ -0,0 +1,256 @@ +/* + * Copyright (C) 2018 The LineageOS Project + * + * 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 "android.hardware.light@2.0-service.kitakami" + +#include +#include +#include + +#include "Light.h" + +// libhwbinder: +using android::hardware::configureRpcThreadpool; +using android::hardware::joinRpcThreadpool; + +// Generated HIDL files +using android::hardware::light::V2_0::ILight; +using android::hardware::light::V2_0::implementation::Light; + +const static std::string kLcdBacklightPath = "/sys/class/leds/lcd-backlight/brightness"; +const static std::string kLcdMaxBacklightPath = "/sys/class/leds/lcd-backlight/max_brightness"; +const static std::string kRedLedPath = "/sys/class/leds/red/brightness"; +const static std::string kGreenLedPath = "/sys/class/leds/green/brightness"; +const static std::string kBlueLedPath = "/sys/class/leds/blue/brightness"; +const static std::string kRedDutyPctsPath = "/sys/class/leds/red/duty_pcts"; +const static std::string kGreenDutyPctsPath = "/sys/class/leds/green/duty_pcts"; +const static std::string kBlueDutyPctsPath = "/sys/class/leds/blue/duty_pcts"; +const static std::string kRedStartIdxPath = "/sys/class/leds/red/start_idx"; +const static std::string kGreenStartIdxPath = "/sys/class/leds/green/start_idx"; +const static std::string kBlueStartIdxPath = "/sys/class/leds/blue/start_idx"; +const static std::string kRedPauseLoPath = "/sys/class/leds/red/pause_lo"; +const static std::string kGreenPauseLoPath = "/sys/class/leds/green/pause_lo"; +const static std::string kBluePauseLoPath = "/sys/class/leds/blue/pause_lo"; +const static std::string kRedPauseHiPath = "/sys/class/leds/red/pause_hi"; +const static std::string kGreenPauseHiPath = "/sys/class/leds/green/pause_hi"; +const static std::string kBluePauseHiPath = "/sys/class/leds/blue/pause_hi"; +const static std::string kRedRampStepMsPath = "/sys/class/leds/red/ramp_step_ms"; +const static std::string kGreenRampStepMsPath = "/sys/class/leds/green/ramp_step_ms"; +const static std::string kBlueRampStepMsPath = "/sys/class/leds/blue/ramp_step_ms"; +const static std::string kRedBlinkPath = "/sys/class/leds/red/blink"; +const static std::string kGreenBlinkPath = "/sys/class/leds/green/blink"; +const static std::string kBlueBlinkPath = "/sys/class/leds/blue/blink"; +const static std::string kRgbBlinkPath = "/sys/class/leds/rgb/rgb_blink"; + +int main() { + uint32_t lcdMaxBrightness = 255; + + std::ofstream lcdBacklight(kLcdBacklightPath); + if (!lcdBacklight) { + LOG(ERROR) << "Failed to open " << kLcdBacklightPath << ", error=" << errno + << " (" << strerror(errno) << ")"; + return -errno; + } + + std::ifstream lcdMaxBacklight(kLcdMaxBacklightPath); + if (!lcdMaxBacklight) { + LOG(ERROR) << "Failed to open " << kLcdMaxBacklightPath << ", error=" << errno + << " (" << strerror(errno) << ")"; + return -errno; + } else { + lcdMaxBacklight >> lcdMaxBrightness; + } + + std::ofstream redLed(kRedLedPath); + if (!redLed) { + LOG(ERROR) << "Failed to open " << kRedLedPath << ", error=" << errno + << " (" << strerror(errno) << ")"; + return -errno; + } + + std::ofstream greenLed(kGreenLedPath); + if (!greenLed) { + LOG(ERROR) << "Failed to open " << kGreenLedPath << ", error=" << errno + << " (" << strerror(errno) << ")"; + return -errno; + } + + std::ofstream blueLed(kBlueLedPath); + if (!blueLed) { + LOG(ERROR) << "Failed to open " << kBlueLedPath << ", error=" << errno + << " (" << strerror(errno) << ")"; + return -errno; + } + + std::ofstream redDutyPcts(kRedDutyPctsPath); + if (!redDutyPcts) { + LOG(ERROR) << "Failed to open " << kRedDutyPctsPath << ", error=" << errno + << " (" << strerror(errno) << ")"; + return -errno; + } + + std::ofstream greenDutyPcts(kGreenDutyPctsPath); + if (!greenDutyPcts) { + LOG(ERROR) << "Failed to open " << kGreenDutyPctsPath << ", error=" << errno + << " (" << strerror(errno) << ")"; + return -errno; + } + + std::ofstream blueDutyPcts(kBlueDutyPctsPath); + if (!blueDutyPcts) { + LOG(ERROR) << "Failed to open " << kBlueDutyPctsPath << ", error=" << errno + << " (" << strerror(errno) << ")"; + return -errno; + } + + std::ofstream redStartIdx(kRedStartIdxPath); + if (!redStartIdx) { + LOG(ERROR) << "Failed to open " << kRedStartIdxPath << ", error=" << errno + << " (" << strerror(errno) << ")"; + return -errno; + } + + std::ofstream greenStartIdx(kGreenStartIdxPath); + if (!greenStartIdx) { + LOG(ERROR) << "Failed to open " << kGreenStartIdxPath << ", error=" << errno + << " (" << strerror(errno) << ")"; + return -errno; + } + + std::ofstream blueStartIdx(kBlueStartIdxPath); + if (!blueStartIdx) { + LOG(ERROR) << "Failed to open " << kBlueStartIdxPath << ", error=" << errno + << " (" << strerror(errno) << ")"; + return -errno; + } + + std::ofstream redPauseLo(kRedPauseLoPath); + if (!redPauseLo) { + LOG(ERROR) << "Failed to open " << kRedPauseLoPath << ", error=" << errno + << " (" << strerror(errno) << ")"; + return -errno; + } + + std::ofstream greenPauseLo(kGreenPauseLoPath); + if (!greenPauseLo) { + LOG(ERROR) << "Failed to open " << kGreenPauseLoPath << ", error=" << errno + << " (" << strerror(errno) << ")"; + return -errno; + } + + std::ofstream bluePauseLo(kBluePauseLoPath); + if (!bluePauseLo) { + LOG(ERROR) << "Failed to open " << kBluePauseLoPath << ", error=" << errno + << " (" << strerror(errno) << ")"; + return -errno; + } + + std::ofstream redPauseHi(kRedPauseHiPath); + if (!redPauseHi) { + LOG(ERROR) << "Failed to open " << kRedPauseHiPath << ", error=" << errno + << " (" << strerror(errno) << ")"; + return -errno; + } + + std::ofstream greenPauseHi(kGreenPauseHiPath); + if (!greenPauseHi) { + LOG(ERROR) << "Failed to open " << kGreenPauseHiPath << ", error=" << errno + << " (" << strerror(errno) << ")"; + return -errno; + } + + std::ofstream bluePauseHi(kBluePauseHiPath); + if (!bluePauseHi) { + LOG(ERROR) << "Failed to open " << kBluePauseHiPath << ", error=" << errno + << " (" << strerror(errno) << ")"; + return -errno; + } + + std::ofstream redRampStepMs(kRedRampStepMsPath); + if (!redRampStepMs) { + LOG(ERROR) << "Failed to open " << kRedRampStepMsPath << ", error=" << errno + << " (" << strerror(errno) << ")"; + return -errno; + } + + std::ofstream greenRampStepMs(kGreenRampStepMsPath); + if (!greenRampStepMs) { + LOG(ERROR) << "Failed to open " << kGreenRampStepMsPath << ", error=" << errno + << " (" << strerror(errno) << ")"; + return -errno; + } + + std::ofstream blueRampStepMs(kBlueRampStepMsPath); + if (!blueRampStepMs) { + LOG(ERROR) << "Failed to open " << kBlueRampStepMsPath << ", error=" << errno + << " (" << strerror(errno) << ")"; + return -errno; + } + + std::ofstream redBlink(kRedBlinkPath); + if (!redBlink) { + LOG(ERROR) << "Failed to open " << kRedBlinkPath << ", error=" << errno + << " (" << strerror(errno) << ")"; + return -errno; + } + + std::ofstream greenBlink(kGreenBlinkPath); + if (!greenBlink) { + LOG(ERROR) << "Failed to open " << kGreenBlinkPath << ", error=" << errno + << " (" << strerror(errno) << ")"; + return -errno; + } + + std::ofstream blueBlink(kBlueBlinkPath); + if (!blueBlink) { + LOG(ERROR) << "Failed to open " << kBlueBlinkPath << ", error=" << errno + << " (" << strerror(errno) << ")"; + return -errno; + } + + std::ofstream rgbBlink(kRgbBlinkPath); + if (!rgbBlink) { + LOG(ERROR) << "Failed to open " << kRgbBlinkPath << ", error=" << errno + << " (" << strerror(errno) << ")"; + return -errno; + } + + android::sp service = new Light( + {std::move(lcdBacklight), lcdMaxBrightness}, + std::move(redLed), std::move(greenLed), std::move(blueLed), + std::move(redDutyPcts), std::move(greenDutyPcts), std::move(blueDutyPcts), + std::move(redStartIdx), std::move(greenStartIdx), std::move(blueStartIdx), + std::move(redPauseLo), std::move(greenPauseLo), std::move(bluePauseLo), + std::move(redPauseHi), std::move(greenPauseHi), std::move(bluePauseHi), + std::move(redRampStepMs), std::move(greenRampStepMs), std::move(blueRampStepMs), + std::move(redBlink), std::move(greenBlink), std::move(blueBlink), + std::move(rgbBlink)); + + configureRpcThreadpool(1, true); + + android::status_t status = service->registerAsService(); + + if (status != android::OK) { + LOG(ERROR) << "Cannot register Light HAL service"; + return 1; + } + + LOG(INFO) << "Light HAL Ready."; + joinRpcThreadpool(); + // Under normal cases, execution will not reach this line. + LOG(ERROR) << "Light HAL failed to join thread pool."; + return 1; +}