From 196ba61f5d9ffbf0f9285c30132673996609e5a2 Mon Sep 17 00:00:00 2001 From: mikeNG Date: Tue, 1 May 2018 16:03:25 +0000 Subject: [PATCH] msm8956-common: Add aw2013 lights HIDL HAL implementation --- light/Android.bp | 31 ++ light/Light.cpp | 352 ++++++++++++++++++ light/Light.h | 78 ++++ ...droid.hardware.light@2.0-service.aw2013.rc | 14 + light/service.cpp | 154 ++++++++ 5 files changed, 629 insertions(+) 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.aw2013.rc create mode 100644 light/service.cpp diff --git a/light/Android.bp b/light/Android.bp new file mode 100644 index 0000000..6d1c8e4 --- /dev/null +++ b/light/Android.bp @@ -0,0 +1,31 @@ +// 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.aw2013", + relative_install_path: "hw", + init_rc: ["android.hardware.light@2.0-service.aw2013.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..d3cb422 --- /dev/null +++ b/light/Light.cpp @@ -0,0 +1,352 @@ +/* + * 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 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); +} + +struct color { + unsigned int r, g, b; + float _L, _a, _b; +}; + +// This hardware only allows primary colors +static struct color colors[] = { + { 255, 0, 0, 0, 0, 0 }, // red + { 255, 255, 0, 0, 0, 0 }, // yellow + { 0, 255, 0, 0, 0, 0 }, // green + { 0, 255, 255, 0, 0, 0 }, // cyan + { 0, 0, 255, 0, 0, 0 }, // blue + { 255, 0, 255, 0, 0, 0 }, // magenta + { 255, 255, 255, 0, 0, 0 }, // white + { 127, 127, 127, 0, 0, 0 }, // grey + { 0, 0, 0, 0, 0, 0 }, // black +}; + +static constexpr int MAX_COLOR = 9; + +// Convert RGB to L*a*b colorspace +// from http://www.brucelindbloom.com +static void rgb2lab(unsigned int R, unsigned int G, unsigned int B, + float *_L, float *_a, float *_b) { + + float r, g, b, X, Y, Z, fx, fy, fz, xr, yr, zr; + float Ls, as, bs; + float eps = 216.f / 24389.f; + float k = 24389.f / 27.f; + + float Xr = 0.964221f; // reference white D50 + float Yr = 1.0f; + float Zr = 0.825211f; + + // RGB to XYZ + r = R / 255.f; //R 0..1 + g = G / 255.f; //G 0..1 + b = B / 255.f; //B 0..1 + + // assuming sRGB (D65) + if (r <= 0.04045) + r = r / 12; + else + r = (float) pow((r + 0.055) / 1.055, 2.4); + + if (g <= 0.04045) + g = g / 12; + else + g = (float) pow((g + 0.055) / 1.055, 2.4); + + if (b <= 0.04045) + b = b / 12; + else + b = (float) pow((b + 0.055) / 1.055, 2.4); + + + X = 0.436052025f * r + 0.385081593f * g + 0.143087414f * b; + Y = 0.222491598f * r + 0.71688606f * g + 0.060621486f * b; + Z = 0.013929122f * r + 0.097097002f * g + 0.71418547f * b; + + // XYZ to Lab + xr = X / Xr; + yr = Y / Yr; + zr = Z / Zr; + + if (xr > eps) + fx = (float) pow(xr, 1 / 3.); + else + fx = (float) ((k * xr + 16.) / 116.); + + if (yr > eps) + fy = (float) pow(yr, 1 / 3.); + else + fy = (float) ((k * yr + 16.) / 116.); + + if (zr > eps) + fz = (float) pow(zr, 1 / 3.); + else + fz = (float) ((k * zr + 16.) / 116); + + Ls = (116 * fy) - 16; + as = 500 * (fx - fy); + bs = 200 * (fy - fz); + + *_L = (2.55 * Ls + .5); + *_a = (as + .5); + *_b = (bs + .5); +} + +// find the color with the shortest distance +static struct color * +nearest_color(unsigned int r, unsigned int g, unsigned int b) +{ + int i = 0; + float _L, _a, _b; + double L_dist, a_dist, b_dist, total; + double distance = 3 * 255; + + struct color *nearest = NULL; + + rgb2lab(r, g, b, &_L, &_a, &_b); + + for (i = 0; i < MAX_COLOR; i++) { + L_dist = pow(_L - colors[i]._L, 2); + a_dist = pow(_a - colors[i]._a, 2); + b_dist = pow(_b - colors[i]._b, 2); + total = sqrt(L_dist + a_dist + b_dist); + if (total < distance) { + nearest = &colors[i]; + distance = total; + } + } + + return nearest; +} + +} // anonymous namespace + +namespace android { +namespace hardware { +namespace light { +namespace V2_0 { +namespace implementation { + +Light::Light(std::pair&& lcd_backlight, std::ofstream&& button_backlight, + std::ofstream&& red_led, std::ofstream&& green_led, std::ofstream&& blue_led, + std::ofstream&& red_blink, std::ofstream&& green_blink, std::ofstream&& blue_blink, + std::ofstream&& red_led_time, std::ofstream&& green_led_time, std::ofstream&& blue_led_time) + : mLcdBacklight(std::move(lcd_backlight)), + mButtonBacklight(std::move(button_backlight)), + mRedLed(std::move(red_led)), + mGreenLed(std::move(green_led)), + mBlueLed(std::move(blue_led)), + mRedBlink(std::move(red_blink)), + mGreenBlink(std::move(green_blink)), + mBlueBlink(std::move(blue_blink)), + mRedLedTime(std::move(red_led_time)), + mGreenLedTime(std::move(green_led_time)), + mBlueLedTime(std::move(blue_led_time)) { + 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 buttonsFn(std::bind(&Light::setButtonsBacklight, 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::BUTTONS, buttonsFn)); + mLights.emplace(std::make_pair(Type::NOTIFICATIONS, notifFn)); + + for (int i = 0; i < MAX_COLOR; i++) { + rgb2lab(colors[i].r, colors[i].g, colors[i].b, + &colors[i]._L, &colors[i]._a, &colors[i]._b); + } +} + +// 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::setButtonsBacklight(const LightState& state) { + std::lock_guard lock(mLock); + + uint32_t brightness = rgbToBrightness(state); + + mButtonBacklight << 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); + mNotificationState = state; + 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; + uint32_t colorRGB = state.color; + char breath_pattern[64] = { 0, }; + struct color *nearest = NULL; + + 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 + mRedLed << 0 << std::endl; + mGreenLed << 0 << std::endl; + mBlueLed << 0 << std::endl; + + if (blink) { + // Driver doesn't permit us to set individual duty cycles, so only + // pick pure colors at max brightness when blinking. + nearest = nearest_color(red, green, blue); + + red = nearest->r; + green = nearest->g; + blue = nearest->b; + + // Make sure the values are between 1 and 7 seconds + if (onMs < 1000) + onMs = 1000; + else if (onMs > 7000) + onMs = 7000; + + if (offMs < 1000) + offMs = 1000; + else if (offMs > 7000) + offMs = 7000; + + // Ramp up, lit, ramp down, unlit. in seconds. + sprintf(breath_pattern, "1 %d 1 %d", (int)(onMs / 1000), (int)(offMs / 1000)); + } else { + blink = 0; + sprintf(breath_pattern, "1 2 1 2"); + } + + // Do everything with the lights out, then turn up the brightness + mRedLedTime << breath_pattern << std::endl; + mRedBlink << (blink && red ? 1 : 0) << std::endl; + mGreenLedTime << breath_pattern << std::endl; + mGreenBlink << (blink && green ? 1 : 0) << std::endl; + mBlueLedTime << breath_pattern << std::endl; + mBlueBlink << (blink && blue ? 1 : 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..28b39b2 --- /dev/null +++ b/light/Light.h @@ -0,0 +1,78 @@ +/* + * 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&& button_backlight, + std::ofstream&& red_led, std::ofstream&& green_led, std::ofstream&& blue_led, + std::ofstream&& red_blink, std::ofstream&& green_blink, std::ofstream&& blue_blink, + std::ofstream&& red_led_time, std::ofstream&& green_led_time, std::ofstream&& blue_led_time); + + // 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 setButtonsBacklight(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 mButtonBacklight; + std::ofstream mRedLed; + std::ofstream mGreenLed; + std::ofstream mBlueLed; + std::ofstream mRedBlink; + std::ofstream mGreenBlink; + std::ofstream mBlueBlink; + std::ofstream mRedLedTime; + std::ofstream mGreenLedTime; + std::ofstream mBlueLedTime; + + 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.aw2013.rc b/light/android.hardware.light@2.0-service.aw2013.rc new file mode 100644 index 0000000..03674dd --- /dev/null +++ b/light/android.hardware.light@2.0-service.aw2013.rc @@ -0,0 +1,14 @@ +on init + # RGB lights + 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/red/led_time + chown system system /sys/class/leds/green/led_time + chown system system /sys/class/leds/blue/led_time + +service light-hal-2-0 /vendor/bin/hw/android.hardware.light@2.0-service.aw2013 + class hal + user system + group system diff --git a/light/service.cpp b/light/service.cpp new file mode 100644 index 0000000..2abcaa0 --- /dev/null +++ b/light/service.cpp @@ -0,0 +1,154 @@ +/* + * 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.aw2013" + +#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 kButtonBacklightPath = "/sys/class/leds/button-backlight/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 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 kRedLedTimePath = "/sys/class/leds/red/led_time"; +const static std::string kGreenLedTimePath = "/sys/class/leds/green/led_time"; +const static std::string kBlueLedTimePath = "/sys/class/leds/blue/led_time"; + +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 buttonBacklight(kButtonBacklightPath); + if (!buttonBacklight) { + LOG(WARNING) << "Failed to open " << kButtonBacklightPath << ", error=" << errno + << " (" << strerror(errno) << ")"; + } + + 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 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 redLedTime(kRedLedTimePath); + if (!redLedTime) { + LOG(ERROR) << "Failed to open " << kRedLedTimePath << ", error=" << errno + << " (" << strerror(errno) << ")"; + return -errno; + } + + std::ofstream greenLedTime(kGreenLedTimePath); + if (!greenLedTime) { + LOG(ERROR) << "Failed to open " << kGreenLedTimePath << ", error=" << errno + << " (" << strerror(errno) << ")"; + return -errno; + } + + std::ofstream blueLedTime(kBlueLedTimePath); + if (!blueBlink) { + LOG(ERROR) << "Failed to open " << kBlueLedTimePath << ", error=" << errno + << " (" << strerror(errno) << ")"; + return -errno; + } + + android::sp service = new Light( + {std::move(lcdBacklight), lcdMaxBrightness}, std::move(buttonBacklight), + std::move(redLed), std::move(greenLed), std::move(blueLed), + std::move(redBlink), std::move(greenBlink), std::move(blueBlink), + std::move(redLedTime), std::move(greenLedTime), std::move(blueLedTime)); + + 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; +}