1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
|
/*
* Copyright (C) 2018 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.
*/
//Author := dev_harsh1998, Isaac Chen
#define LOG_TAG "android.hardware.light@2.0-service.xiaomi_sdm660"
#include <log/log.h>
#include <fstream>
#include "Light.h"
namespace android {
namespace hardware {
namespace light {
namespace V2_0 {
namespace implementation {
#define LEDS "/sys/class/leds/"
#define LCD_LED LEDS "lcd-backlight/"
#define BRIGHTNESS "brightness"
#define WHITE LEDS "red/"
#define BLINK "blink"
#define DUTY_PCTS "duty_pcts"
#define PAUSE_HI "pause_hi"
#define PAUSE_LO "pause_lo"
#define RAMP_STEP_MS "ramp_step_ms"
#define START_IDX "start_idx"
#define MAX_LED_BRIGHTNESS 255
#define MAX_LCD_BRIGHTNESS 4095
/*
* 8 duty percent steps.
*/
#define RAMP_STEPS 8
/*
* Each step will stay on for 50ms by default.
*/
#define RAMP_STEP_DURATION 50
/*
* Each value represents a duty percent (0 - 100) for the led pwm.
*/
static int32_t BRIGHTNESS_RAMP[RAMP_STEPS] = {0, 12, 25, 37, 50, 72, 85, 100};
/*
* Write value to path and close file.
*/
static void set(std::string path, std::string value) {
std::ofstream file(path);
/* Only write brightness value if stream is open, alive & well */
if (file.is_open()) {
file << value;
} else {
/* Fire a warning a bail out */
ALOGE("failed to write %s to %s", value.c_str(), path.c_str());
return;
}
}
static void set(std::string path, int value) {
set(path, std::to_string(value));
}
static uint32_t getBrightness(const LightState& state) {
uint32_t alpha, red, green, blue;
/*
* Extract brightness from AARRGGBB.
*/
alpha = (state.color >> 24) & 0xFF;
red = (state.color >> 16) & 0xFF;
green = (state.color >> 8) & 0xFF;
blue = state.color & 0xFF;
/*
* Scale RGB brightness if Alpha brightness is not 0xFF.
*/
if (alpha != 0xFF) {
red = red * alpha / 0xFF;
green = green * alpha / 0xFF;
blue = blue * alpha / 0xFF;
}
return (77 * red + 150 * green + 29 * blue) >> 8;
}
/*
* Scale each value of the brightness ramp according to the
* brightness of the color.
*/
static std::string getScaledRamp(uint32_t brightness) {
std::string ramp, pad;
for (auto const& step : BRIGHTNESS_RAMP) {
ramp += pad + std::to_string(step * brightness / 0xFF);
pad = ",";
}
return ramp;
}
static inline uint32_t scaleBrightness(uint32_t brightness, uint32_t maxBrightness) {
return brightness * maxBrightness / 0xFF;
}
static inline uint32_t getScaledBrightness(const LightState& state, uint32_t maxBrightness) {
return scaleBrightness(getBrightness(state), maxBrightness);
}
static void handleXiaomiBacklight(Type /*type*/, const LightState& state) {
uint32_t brightness = getScaledBrightness(state, MAX_LCD_BRIGHTNESS);
set(LCD_LED BRIGHTNESS, brightness);
}
static void setNotification(const LightState& state) {
uint32_t whiteBrightness = getScaledBrightness(state, MAX_LED_BRIGHTNESS);
/* Turn off the leds (initially) */
set(WHITE BLINK, 0);
if (state.flashMode == Flash::TIMED) {
/*
* If the flashOnMs duration is not long enough to fit ramping up
* and down at the default step duration, step duration is modified
* to fit.
*/
int32_t stepDuration = RAMP_STEP_DURATION;
int32_t pauseHi = state.flashOnMs - (stepDuration * RAMP_STEPS * 2);
int32_t pauseLo = state.flashOffMs;
if (pauseHi < 0) {
pauseHi = 0;
}
/* White */
set(WHITE BLINK, 1);
set(WHITE START_IDX, 0 * RAMP_STEPS);
set(WHITE DUTY_PCTS, getScaledRamp(whiteBrightness));
set(WHITE PAUSE_LO, pauseLo);
set(WHITE PAUSE_HI, pauseHi);
set(WHITE RAMP_STEP_MS, stepDuration);
} else {
set(WHITE BRIGHTNESS, whiteBrightness);
}
}
static inline bool isLit(const LightState& state) {
return state.color & 0x00ffffff;
}
/*
* Keep sorted in the order of importance.
*/
static const LightState offState = {};
static std::vector<std::pair<Type, LightState>> notificationStates = {
{ Type::ATTENTION, offState },
{ Type::NOTIFICATIONS, offState },
{ Type::BATTERY, offState },
};
static void handleXiaomiNotification(Type type, const LightState& state) {
for(auto it : notificationStates) {
if (it.first == type) {
it.second = state;
}
if (isLit(it.second)) {
setNotification(it.second);
return;
}
}
setNotification(offState);
}
static std::map<Type, std::function<void(Type type, const LightState&)>> lights = {
{Type::BACKLIGHT, handleXiaomiBacklight},
{Type::NOTIFICATIONS, handleXiaomiNotification},
{Type::BATTERY, handleXiaomiNotification},
{Type::ATTENTION, handleXiaomiNotification},
};
Light::Light() {}
Return<Status> Light::setLight(Type type, const LightState& state) {
auto it = lights.find(type);
if (it == lights.end()) {
return Status::LIGHT_NOT_SUPPORTED;
}
/*
* Lock global mutex until light state is updated.
*/
std::lock_guard<std::mutex> lock(globalLock);
it->second(type, state);
return Status::SUCCESS;
}
Return<void> Light::getSupportedTypes(getSupportedTypes_cb _hidl_cb) {
std::vector<Type> types;
for (auto const& light : lights) types.push_back(light.first);
_hidl_cb(types);
return Void();
}
} // namespace implementation
} // namespace V2_0
} // namespace light
} // namespace hardware
} // namespace android
|
