forked from g7/mce-plugin-libhybris
-
Notifications
You must be signed in to change notification settings - Fork 1
/
hybris-fb.c
295 lines (251 loc) · 8.48 KB
/
hybris-fb.c
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
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
/** @file hybris-fb.c
*
* mce-plugin-libhybris - Libhybris plugin for Mode Control Entity
* <p>
* Copyright (C) 2013-2017 Jolla Ltd.
* <p>
* @author Simo Piiroinen <[email protected]>
*
* mce-plugin-libhybris is free software; you can redistribute it and/or
* modify it under the terms of the GNU Lesser General Public
* License as published by the Free Software Foundation; either
* version 2.1 of the License.
*
* mce-plugin-libhybris is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
* Lesser General Public License for more details.
*
* You should have received a copy of the GNU Lesser General Public License
* along with mce-plugin-libhybris; if not, write to the Free Software
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
*/
#include "hybris-fb.h"
#include "plugin-logging.h"
#include "plugin-api.h"
#include <system/window.h>
#include <hardware/gralloc.h>
#include <hardware/fb.h>
#include <hardware/hwcomposer.h>
/* ========================================================================= *
* PROTOTYPES
* ========================================================================= */
/* ------------------------------------------------------------------------- *
* FRAMEBUFFER_PLUGIN
* ------------------------------------------------------------------------- */
bool hybris_plugin_fb_load (void);
void hybris_plugin_fb_unload (void);
/* ------------------------------------------------------------------------- *
* FRAMEBUFFER_DEVICE
* ------------------------------------------------------------------------- */
bool hybris_device_fb_init (void);
void hybris_device_fb_quit (void);
bool hybris_device_fb_set_power (bool state);
/* ========================================================================= *
* FRAMEBUFFER_PLUGIN
* ========================================================================= */
/** Handle for libhybris framebuffer plugin */
static const struct hw_module_t *hybris_plugin_fb_handle = 0;
/** Handle for libhybris hw composer plugin */
static const struct hw_module_t *hybris_plugin_hwc_handle = 0;
/** Load libhybris framebuffer plugin
*
* @return true on success, false on failure
*/
bool
hybris_plugin_fb_load(void)
{
static bool done = false;
if( done ) {
goto cleanup;
}
done = true;
/* Load framebuffer module */
hw_get_module(GRALLOC_HARDWARE_MODULE_ID, &hybris_plugin_fb_handle);
if( !hybris_plugin_fb_handle ) {
mce_log(LL_DEBUG, "failed to open frame buffer module");
}
/* Load hw composer module */
#ifdef HWC_DEVICE_API_VERSION_1_0
hw_get_module(HWC_HARDWARE_MODULE_ID, &hybris_plugin_hwc_handle);
if( !hybris_plugin_hwc_handle ) {
mce_log(LL_DEBUG, "failed to open hw composer module");
}
#else
/* When compiling with really old hwcompser.h in place, assume
* that the target device is not going to have the hwc methods we
* are interested in -> skip module load -> hwc device loading and
* related cleanup turns into a nop without further #ifdeffing.
*/
#endif
/* Both fb and hwc are optional, but having neither is unexpected */
if( !hybris_plugin_fb_handle && !hybris_plugin_hwc_handle ) {
mce_log(LL_WARN, "could not open neither fb nor hwc module");
}
cleanup:
return hybris_plugin_fb_handle || hybris_plugin_hwc_handle;
}
/** Unload libhybris framebuffer plugin
*/
void
hybris_plugin_fb_unload(void)
{
/* Close open devices */
hybris_device_fb_quit();
/* Unload modules */
// FIXME: how to unload libhybris modules?
hybris_plugin_fb_handle = 0;
hybris_plugin_hwc_handle = 0;
}
/* ========================================================================= *
* FRAMEBUFFER_DEVICE
* ========================================================================= */
/** Pointer to libhybris frame buffer device object */
static framebuffer_device_t *hybris_device_fb_handle = 0;
/** Pointer to libhybris frame buffer device object */
#ifdef HWC_DEVICE_API_VERSION_1_0
static hwc_composer_device_1_t *hybris_device_hwc_handle = 0;
#else
static hwc_composer_device_t *hybris_device_hwc_handle = 0;
#endif
/** Initialize libhybris frame buffer device object
*
* @return true on success, false on failure
*/
bool
hybris_device_fb_init(void)
{
static bool ack = false;
static bool done = false;
if( done ) {
goto cleanup;
}
done = true;
if( !hybris_plugin_fb_load() ) {
goto cleanup;
}
/* Open frame buffer device */
if( hybris_plugin_fb_handle ) {
hybris_plugin_fb_handle->methods->open(hybris_plugin_fb_handle,
GRALLOC_HARDWARE_FB0,
(hw_device_t**)&hybris_device_fb_handle);
if( !hybris_device_fb_handle ) {
mce_log(LL_WARN, "failed to open frame buffer device");
}
}
/* Open hw composer device */
if( hybris_plugin_hwc_handle ) {
hybris_plugin_hwc_handle->methods->open(hybris_plugin_hwc_handle,
HWC_HARDWARE_COMPOSER,
(hw_device_t**)&hybris_device_hwc_handle);
if( !hybris_device_hwc_handle ) {
mce_log(LL_WARN, "failed to open hw composer device");
}
}
/* What we'd like to use is:
*
* 1. hwc_dev->setPowerMode()
* 2. hwc_dev->blank()
* 2. fb_dev->enableScreen()
*
* While all are optional, having none available is unexpected.
*/
#ifdef HWC_DEVICE_API_VERSION_1_0
if( hybris_device_hwc_handle ) {
# ifdef HWC_DEVICE_API_VERSION_1_4
if( hybris_device_hwc_handle->common.version >= HWC_DEVICE_API_VERSION_1_4 &&
hybris_device_hwc_handle->setPowerMode ) {
mce_log(LL_DEBUG, "using hw composer setPowerMode() method");
ack = true;
goto cleanup;
}
# endif
if( hybris_device_hwc_handle->blank ) {
mce_log(LL_DEBUG, "using hw composer blank() method");
ack = true;
goto cleanup;
}
}
#endif
if( hybris_device_fb_handle ) {
if( hybris_device_fb_handle->enableScreen ) {
mce_log(LL_DEBUG, "using framebuffer enableScreen() method");
ack = true;
goto cleanup;
}
}
mce_log(LL_WARN, "no known display power control interfaces");
cleanup:
return ack;
}
/** Release libhybris frame buffer device object
*/
void
hybris_device_fb_quit(void)
{
if( hybris_device_hwc_handle ) {
hybris_device_hwc_handle->common.close(&hybris_device_hwc_handle->common);
hybris_device_hwc_handle = 0;
}
if( hybris_device_fb_handle ) {
hybris_device_fb_handle->common.close(&hybris_device_fb_handle->common);
hybris_device_fb_handle = 0;
}
}
/** Set frame buffer power state via libhybris
*
* @param state true to power on, false to power off
*
* @return true on success, false on failure
*/
bool
hybris_device_fb_set_power(bool state)
{
bool ack = false;
if( !hybris_device_fb_init() ) {
goto cleanup;
}
/* Try hwc methods */
#ifdef HWC_DEVICE_API_VERSION_1_0
if( hybris_device_hwc_handle ) {
# ifdef HWC_DEVICE_API_VERSION_1_4
if( hybris_device_hwc_handle->common.version >= HWC_DEVICE_API_VERSION_1_4 &&
hybris_device_hwc_handle->setPowerMode ) {
int disp = 0;
int mode = state ? HWC_POWER_MODE_NORMAL : HWC_POWER_MODE_OFF;
int err = hybris_device_hwc_handle->setPowerMode(hybris_device_hwc_handle,
disp, mode);
mce_log(err ? LL_WARN : LL_DEBUG, "setPowerMode(%d, %d) -> err=%d ",
disp, mode, err);
ack = !err;
goto cleanup;
}
# endif
if( hybris_device_hwc_handle->blank ) {
int disp = 0;
int blank = state ? false : true;
int err = hybris_device_hwc_handle->blank(hybris_device_hwc_handle,
disp, blank);
mce_log(err ? LL_WARN : LL_DEBUG, "blank(%d, %d) -> err=%d ",
disp, blank, err);
ack = !err;
goto cleanup;
}
}
#endif
/* Try fb methods */
if( hybris_device_fb_handle ) {
if( hybris_device_fb_handle->enableScreen ) {
int err = hybris_device_fb_handle->enableScreen(hybris_device_fb_handle,
state);
mce_log(err ? LL_WARN : LL_DEBUG, "enableScreen(%d) -> err=%d ",
state, err);
ack = !err;
goto cleanup;
}
}
/* Failed */
mce_log(LL_WARN, "no known display power control interfaces");
cleanup:
return ack;
}