hidl: add hidl lights hal
Change-Id: I333c8d3e20bb451d208f15661afc06ac47e1a377
diff --git a/hidl/light/Light.cpp b/hidl/light/Light.cpp
new file mode 100644
index 0000000..cc5e5d4
--- /dev/null
+++ b/hidl/light/Light.cpp
@@ -0,0 +1,202 @@
+/*
+ * Copyright (C) 2019 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.samsung"
+
+#include <iomanip>
+
+#include "Light.h"
+
+#define COLOR_MASK 0x00ffffff
+#define MAX_INPUT_BRIGHTNESS 255
+
+using android::hardware::light::V2_0::LightState;
+using android::hardware::light::V2_0::Status;
+using android::hardware::light::V2_0::Type;
+
+namespace android {
+namespace hardware {
+namespace light {
+namespace V2_0 {
+namespace implementation {
+
+/*
+ * Write value to path and close file.
+ */
+template <typename T>
+static void set(const std::string& path, const T& value) {
+ std::ofstream file(path);
+ file << value << std::endl;
+}
+
+template <typename T>
+static T get(const std::string& path, const T& def) {
+ std::ifstream file(path);
+ T result;
+
+ file >> result;
+ return file.fail() ? def : result;
+}
+
+Light::Light() {
+ mLights.emplace(Type::BACKLIGHT,
+ std::bind(&Light::handleBacklight, this, std::placeholders::_1));
+#ifdef BUTTON_BRIGHTNESS_NODE
+ mLights.emplace(Type::BUTTONS, std::bind(&Light::handleButtons, this, std::placeholders::_1));
+#endif
+ mLights.emplace(Type::BATTERY, std::bind(&Light::handleBattery, this, std::placeholders::_1));
+ mLights.emplace(Type::NOTIFICATIONS,
+ std::bind(&Light::handleNotifications, this, std::placeholders::_1));
+ mLights.emplace(Type::ATTENTION,
+ std::bind(&Light::handleAttention, this, std::placeholders::_1));
+}
+
+Return<Status> Light::setLight(Type type, const LightState& state) {
+ auto it = mLights.find(type);
+
+ if (it == mLights.end()) {
+ return Status::LIGHT_NOT_SUPPORTED;
+ }
+
+ /*
+ * Lock global mutex until light state is updated.
+ */
+ std::lock_guard<std::mutex> lock(mLock);
+
+ it->second(state);
+
+ return Status::SUCCESS;
+}
+
+void Light::handleBacklight(const LightState& state) {
+ uint32_t max_brightness = get(PANEL_MAX_BRIGHTNESS_NODE, MAX_INPUT_BRIGHTNESS);
+ uint32_t brightness = rgbToBrightness(state);
+
+ if (max_brightness != MAX_INPUT_BRIGHTNESS) {
+ brightness = brightness * max_brightness / MAX_INPUT_BRIGHTNESS;
+ }
+
+ set(PANEL_BRIGHTNESS_NODE, brightness);
+}
+
+#ifdef BUTTON_BRIGHTNESS_NODE
+void Light::handleButtons(const LightState& state) {
+#ifdef VAR_BUTTON_BRIGHTNESS
+ uint32_t brightness = rgbToBrightness(state);
+#else
+ uint32_t brightness = (state.color & COLOR_MASK) ? 1 : 0;
+#endif
+
+ set(BUTTON_BRIGHTNESS_NODE, brightness);
+}
+#endif
+
+void Light::handleBattery(const LightState& state) {
+ mBatteryState = state;
+ setNotificationLED();
+}
+
+void Light::handleNotifications(const LightState& state) {
+ mNotificationState = state;
+ setNotificationLED();
+}
+
+void Light::handleAttention(const LightState& state) {
+ mAttentionState = state;
+ setNotificationLED();
+}
+
+void Light::setNotificationLED() {
+ int32_t adjusted_brightness = MAX_INPUT_BRIGHTNESS;
+ LightState state;
+#ifdef LED_BLN_NODE
+ bool bln = false;
+#endif
+
+ if (mBatteryState.color & COLOR_MASK) {
+ adjusted_brightness = LED_BRIGHTNESS_BATTERY;
+ state = mBatteryState;
+ } else if (mNotificationState.color & COLOR_MASK) {
+ adjusted_brightness = LED_BRIGHTNESS_NOTIFICATION;
+ state = mNotificationState;
+#ifdef LED_BLN_NODE
+ bln = true;
+#endif
+ } else if (mAttentionState.color & COLOR_MASK) {
+ adjusted_brightness = LED_BRIGHTNESS_ATTENTION;
+ state = mAttentionState;
+ if (state.flashMode == Flash::HARDWARE) {
+ if (state.flashOnMs > 0 && state.flashOffMs == 0) state.flashMode = Flash::NONE;
+ state.color = 0x000000ff;
+ }
+ if (state.flashMode == Flash::NONE) {
+ state.color = 0;
+ }
+ } else {
+ set(LED_BLINK_NODE, "0x00000000 0 0");
+ return;
+ }
+
+ if (state.flashMode == Flash::NONE) {
+ state.flashOnMs = 0;
+ state.flashOffMs = 0;
+ }
+
+ state.color = calibrateColor(state.color & COLOR_MASK, adjusted_brightness);
+ std::stringstream ss;
+ ss << std::hex << "0x" << std::setfill('0') << std::setw(8) << state.color << std::dec
+ << " " << state.flashOnMs << " " << state.flashOffMs;
+ set(LED_BLINK_NODE, ss.str());
+
+#ifdef LED_BLN_NODE
+ if (bln) {
+ set(LED_BLN_NODE, (state.color & COLOR_MASK) ? 1 : 0);
+ }
+#endif
+}
+
+Return<void> Light::getSupportedTypes(getSupportedTypes_cb _hidl_cb) {
+ std::vector<Type> types;
+
+ for (auto const& light : mLights) {
+ types.push_back(light.first);
+ }
+
+ _hidl_cb(types);
+
+ return Void();
+}
+
+uint32_t Light::rgbToBrightness(const LightState& state) {
+ uint32_t color = state.color & COLOR_MASK;
+
+ return ((77 * ((color >> 16) & 0xff)) + (150 * ((color >> 8) & 0xff)) + (29 * (color & 0xff))) >>
+ 8;
+}
+
+uint32_t Light::calibrateColor(uint32_t color, int32_t brightness) {
+ uint32_t red = ((color >> 16) & 0xFF) * LED_ADJUSTMENT_R;
+ uint32_t green = ((color >> 8) & 0xFF) * LED_ADJUSTMENT_G;
+ uint32_t blue = (color & 0xFF) * LED_ADJUSTMENT_B;
+
+ return (((red * brightness) / 255) << 16) + (((green * brightness) / 255) << 8) +
+ ((blue * brightness) / 255);
+}
+
+} // namespace implementation
+} // namespace V2_0
+} // namespace light
+} // namespace hardware
+} // namespace android