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
|
// SPDX-License-Identifier: Apache-2.0
/*
* Copyright (C) 2014 Intel Corporation
*
*/
#include <stdlib.h>
#include <stdbool.h>
#include <string.h>
#include "hal-log.h"
#include "hal.h"
#include "hal-msg.h"
#include "hal-ipc.h"
static const btmce_callbacks_t *cbs = NULL;
static bool interface_ready(void)
{
return cbs != NULL;
}
/* Event Handlers */
static void remote_mas_instances_to_hal(btmce_mas_instance_t *send_instance,
struct hal_map_client_mas_instance *instance,
int num_instances, uint16_t len)
{
void *buf = instance;
char *name;
int i;
DBG("");
for (i = 0; i < num_instances; i++) {
name = (char *) instance->name;
if (sizeof(*instance) + instance->name_len > len ||
(instance->name_len != 0 &&
name[instance->name_len - 1] != '\0')) {
error("invalid remote mas instance %d, aborting", i);
exit(EXIT_FAILURE);
}
send_instance[i].id = instance->id;
send_instance[i].msg_types = instance->msg_types;
send_instance[i].scn = instance->scn;
send_instance[i].p_name = name;
len -= sizeof(*instance) + instance->name_len;
buf += sizeof(*instance) + instance->name_len;
instance = buf;
}
if (!len)
return;
error("invalid remote mas instances (%u bytes left), aborting", len);
exit(EXIT_FAILURE);
}
static void handle_remote_mas_instances(void *buf, uint16_t len, int fd)
{
struct hal_ev_map_client_remote_mas_instances *ev = buf;
btmce_mas_instance_t instances[ev->num_instances];
DBG("");
len -= sizeof(*ev);
remote_mas_instances_to_hal(instances, ev->instances, ev->num_instances,
len);
if (cbs->remote_mas_instances_cb)
cbs->remote_mas_instances_cb(ev->status,
(bt_bdaddr_t *) ev->bdaddr,
ev->num_instances, instances);
}
/*
* handlers will be called from notification thread context,
* index in table equals to 'opcode - HAL_MINIMUM_EVENT'
*/
static const struct hal_ipc_handler ev_handlers[] = {
/* HAL_EV_MCE_REMOTE_MAS_INSTANCES */
{ handle_remote_mas_instances, true,
sizeof(struct hal_ev_map_client_remote_mas_instances) }
};
/* API */
static bt_status_t get_remote_mas_instances(bt_bdaddr_t *bd_addr)
{
struct hal_cmd_map_client_get_instances cmd;
if (!interface_ready())
return BT_STATUS_NOT_READY;
memcpy(cmd.bdaddr, bd_addr, sizeof(*bd_addr));
return hal_ipc_cmd(HAL_SERVICE_ID_MAP_CLIENT,
HAL_OP_MAP_CLIENT_GET_INSTANCES, sizeof(cmd),
&cmd, NULL, NULL, NULL);
}
static bt_status_t init(btmce_callbacks_t *callbacks)
{
struct hal_cmd_register_module cmd;
int ret;
DBG("");
/*
* Interface ready check was removed because there is no cleanup
* function to unregister and clear callbacks. MAP client testers may
* restart bluetooth, unregister this profile and try to reuse it.
* This situation make service unregistered but callbacks are still
* set - interface is ready. On android devices there is no need to
* re-init MAP client profile while bluetooth is loaded.
*/
cbs = callbacks;
hal_ipc_register(HAL_SERVICE_ID_MAP_CLIENT, ev_handlers,
sizeof(ev_handlers)/sizeof(ev_handlers[0]));
cmd.service_id = HAL_SERVICE_ID_MAP_CLIENT;
cmd.mode = HAL_MODE_DEFAULT;
cmd.max_clients = 1;
ret = hal_ipc_cmd(HAL_SERVICE_ID_CORE, HAL_OP_REGISTER_MODULE,
sizeof(cmd), &cmd, 0, NULL, NULL);
if (ret != BT_STATUS_SUCCESS) {
cbs = NULL;
hal_ipc_unregister(HAL_SERVICE_ID_MAP_CLIENT);
}
return ret;
}
static btmce_interface_t iface = {
.size = sizeof(iface),
.init = init,
.get_remote_mas_instances = get_remote_mas_instances
};
btmce_interface_t *bt_get_map_client_interface(void)
{
return &iface;
}
|
