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
|
/* Copyright (C) 2007-2008 The Android Open Source Project
**
** This software is licensed under the terms of the GNU General Public
** License version 2, as published by the Free Software Foundation, and
** may be copied, distributed, and modified under those terms.
**
** This program 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 General Public License for more details.
*/
/* this file implements the support of the new 'hardware control'
* qemud communication channel, which is used by libs/hardware on
* the system image to communicate with the emulator program for
* emulating the following:
*
* - power management
* - led(s) brightness
* - vibrator
* - flashlight
*/
#include "android/hw-control.h"
#include "cbuffer.h"
#include "android/hw-qemud.h"
#include "android/utils/misc.h"
#include "android/utils/debug.h"
#include "qemu-char.h"
#include <stdio.h>
#include <string.h>
#define D(...) VERBOSE_PRINT(hw_control,__VA_ARGS__)
/* define T_ACTIVE to 1 to debug transport communications */
#define T_ACTIVE 0
#if T_ACTIVE
#define T(...) VERBOSE_PRINT(hw_control,__VA_ARGS__)
#else
#define T(...) ((void)0)
#endif
typedef struct {
void* client;
AndroidHwControlFuncs client_funcs;
QemudService* service;
} HwControl;
/* handle query */
static void hw_control_do_query( HwControl* h, uint8_t* query, int querylen );
/* called when a qemud client sends a command */
static void
_hw_control_qemud_client_recv( void* opaque,
uint8_t* msg,
int msglen )
{
hw_control_do_query(opaque, msg, msglen);
}
/* called when a qemud client connects to the service */
static QemudClient*
_hw_control_qemud_connect( void* opaque, QemudService* service, int channel )
{
QemudClient* client;
client = qemud_client_new( service, channel,
opaque,
_hw_control_qemud_client_recv,
NULL );
qemud_client_set_framing(client, 1);
return client;
}
static uint8_t*
if_starts_with( uint8_t* buf, int buflen, const char* prefix )
{
int prefixlen = strlen(prefix);
if (buflen < prefixlen || memcmp(buf, prefix, prefixlen))
return NULL;
return (uint8_t*)buf + prefixlen;
}
static void
hw_control_do_query( HwControl* h,
uint8_t* query,
int querylen )
{
uint8_t* q;
T("%s: query %4d '%.*s'", __FUNCTION__, querylen, querylen, query );
q = if_starts_with( query, querylen, "power:light:brightness:" );
if (q != NULL) {
if (h->client_funcs.light_brightness) {
char* qq = strchr((const char*)q, ':');
int value;
if (qq == NULL) {
D("%s: badly formatted", __FUNCTION__ );
return;
}
*qq++ = 0;
value = atoi(qq);
h->client_funcs.light_brightness( h->client, (char*)q, value );
}
return;
}
}
static void
hw_control_init( HwControl* control,
void* client,
const AndroidHwControlFuncs* client_funcs )
{
control->client = client;
control->client_funcs = client_funcs[0];
control->service = qemud_service_register( "hw-control", 0,
control,
_hw_control_qemud_connect );
}
void
android_hw_control_init( void* opaque, const AndroidHwControlFuncs* funcs )
{
static HwControl hwstate[1];
hw_control_init(hwstate, opaque, funcs);
D("%s: hw-control qemud handler initialized", __FUNCTION__);
}
|