1 /******************************************************************************
2 *
3 * Copyright (C) 2014 Google, Inc.
4 *
5 * Licensed under the Apache License, Version 2.0 (the "License");
6 * you may not use this file except in compliance with the License.
7 * You may obtain a copy of the License at:
8 *
9 * http://www.apache.org/licenses/LICENSE-2.0
10 *
11 * Unless required by applicable law or agreed to in writing, software
12 * distributed under the License is distributed on an "AS IS" BASIS,
13 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
14 * See the License for the specific language governing permissions and
15 * limitations under the License.
16 *
17 ******************************************************************************/
18
19 #include <assert.h>
20 #include <string.h>
21 #include "btcore/include/bdaddr.h"
22 #include "btcore/include/device_class.h"
23 #include "btcore/include/property.h"
24 #include "btcore/include/uuid.h"
25 #include "osi/include/allocator.h"
26
27 static bt_property_t *property_new_(void *val, size_t len, bt_property_type_t type);
28
property_copy_array(const bt_property_t * properties,size_t count)29 bt_property_t *property_copy_array(const bt_property_t *properties, size_t count) {
30 assert(properties != NULL);
31 bt_property_t *clone = osi_calloc(sizeof(bt_property_t) * count);
32 if (!clone) {
33 return NULL;
34 }
35
36 memcpy(&clone[0], &properties[0], sizeof(bt_property_t) * count);
37 for (size_t i = 0; i < count; ++i) {
38 clone[i].val = osi_calloc(clone[i].len);
39 memcpy(clone[i].val, properties[i].val, clone[i].len);
40 }
41
42 return clone;
43 }
44
property_copy(bt_property_t * dest,const bt_property_t * src)45 bt_property_t *property_copy(bt_property_t *dest, const bt_property_t *src) {
46 assert(dest != NULL);
47 assert(src != NULL);
48 return (bt_property_t *)memcpy(dest, src, sizeof(bt_property_t));
49 }
50
property_equals(const bt_property_t * p1,const bt_property_t * p2)51 bool property_equals(const bt_property_t *p1, const bt_property_t *p2) {
52 // Two null properties are not the same. May need to revisit that
53 // decision when we have a test case that exercises that condition.
54 if (!p1 || !p2 || p1->type != p2->type) {
55 return false;
56 }
57
58 // Although the Bluetooth name is a 249-byte array, the implementation
59 // treats it like a variable-length array with its size specified in the
60 // property's `len` field. We special-case the equivalence of BDNAME
61 // types here by truncating the larger, zero-padded name to its string
62 // length and comparing against the shorter name.
63 //
64 // Note: it may be the case that both strings are zero-padded but that
65 // hasn't come up yet so this implementation doesn't handle it.
66 if (p1->type == BT_PROPERTY_BDNAME && p1->len != p2->len) {
67 const bt_property_t *shorter = p1, *longer = p2;
68 if (p1->len > p2->len) {
69 shorter = p2;
70 longer = p1;
71 }
72 return strlen((const char *)longer->val) == (size_t)shorter->len && !memcmp(longer->val, shorter->val, shorter->len);
73 }
74
75 return p1->len == p2->len && !memcmp(p1->val, p2->val, p1->len);
76 }
77
property_new_addr(const bt_bdaddr_t * addr)78 bt_property_t *property_new_addr(const bt_bdaddr_t *addr) {
79 assert(addr != NULL);
80 return property_new_((void *)addr, sizeof(bt_bdaddr_t), BT_PROPERTY_BDADDR);
81 }
82
property_new_device_class(const bt_device_class_t * dc)83 bt_property_t *property_new_device_class(const bt_device_class_t *dc) {
84 assert(dc != NULL);
85 return property_new_((void *)dc, sizeof(bt_device_class_t), BT_PROPERTY_CLASS_OF_DEVICE);
86 }
87
property_new_device_type(bt_device_type_t type)88 bt_property_t *property_new_device_type(bt_device_type_t type) {
89 return property_new_((void *)&type, sizeof(bt_device_type_t), BT_PROPERTY_TYPE_OF_DEVICE);
90 }
91
property_new_discovery_timeout(const uint32_t timeout)92 bt_property_t *property_new_discovery_timeout(const uint32_t timeout) {
93 return property_new_((void *)&timeout, sizeof(uint32_t), BT_PROPERTY_ADAPTER_DISCOVERY_TIMEOUT);
94 }
95
property_new_name(const char * name)96 bt_property_t *property_new_name(const char *name) {
97 assert(name != NULL);
98 return property_new_((void *)name, sizeof(bt_bdname_t), BT_PROPERTY_BDNAME);
99 }
100
property_new_rssi(int8_t rssi)101 bt_property_t *property_new_rssi(int8_t rssi) {
102 return property_new_((void *)&rssi, sizeof(int8_t), BT_PROPERTY_REMOTE_RSSI);
103 }
104
property_new_scan_mode(bt_scan_mode_t scan_mode)105 bt_property_t *property_new_scan_mode(bt_scan_mode_t scan_mode) {
106 return property_new_((void *)&scan_mode, sizeof(bt_scan_mode_t), BT_PROPERTY_ADAPTER_SCAN_MODE);
107 }
108
property_new_uuids(const bt_uuid_t * uuid,size_t count)109 bt_property_t *property_new_uuids(const bt_uuid_t *uuid, size_t count) {
110 assert(uuid != NULL);
111 return property_new_((void *)uuid, sizeof(bt_uuid_t) * count, BT_PROPERTY_UUIDS);
112 }
113
property_free(bt_property_t * property)114 void property_free(bt_property_t *property) {
115 property_free_array(property, 1);
116 }
117
property_free_array(bt_property_t * properties,size_t count)118 void property_free_array(bt_property_t *properties, size_t count) {
119 if (properties == NULL)
120 return;
121
122 for (size_t i = 0; i < count; ++i) {
123 osi_free(properties[i].val);
124 }
125
126 osi_free(properties);
127 }
128
property_is_addr(const bt_property_t * property)129 bool property_is_addr(const bt_property_t *property) {
130 assert(property != NULL);
131 return property->type == BT_PROPERTY_BDADDR;
132 }
133
property_is_device_class(const bt_property_t * property)134 bool property_is_device_class(const bt_property_t *property) {
135 assert(property != NULL);
136 return property->type == BT_PROPERTY_CLASS_OF_DEVICE;
137 }
138
property_is_device_type(const bt_property_t * property)139 bool property_is_device_type(const bt_property_t *property) {
140 assert(property != NULL);
141 return property->type == BT_PROPERTY_TYPE_OF_DEVICE;
142 }
143
property_is_discovery_timeout(const bt_property_t * property)144 bool property_is_discovery_timeout(const bt_property_t *property) {
145 assert(property != NULL);
146 return property->type == BT_PROPERTY_ADAPTER_DISCOVERY_TIMEOUT;
147 }
148
property_is_name(const bt_property_t * property)149 bool property_is_name(const bt_property_t *property) {
150 assert(property != NULL);
151 return property->type == BT_PROPERTY_BDNAME;
152 }
153
property_is_rssi(const bt_property_t * property)154 bool property_is_rssi(const bt_property_t *property) {
155 assert(property != NULL);
156 return property->type == BT_PROPERTY_REMOTE_RSSI;
157 }
158
property_is_scan_mode(const bt_property_t * property)159 bool property_is_scan_mode(const bt_property_t *property) {
160 assert(property != NULL);
161 return property->type == BT_PROPERTY_ADAPTER_SCAN_MODE;
162 }
163
property_is_uuids(const bt_property_t * property)164 bool property_is_uuids(const bt_property_t *property) {
165 assert(property != NULL);
166 return property->type == BT_PROPERTY_UUIDS;
167 }
168
169 // Convenience conversion methods to property values
property_as_addr(const bt_property_t * property)170 const bt_bdaddr_t *property_as_addr(const bt_property_t *property) {
171 assert(property_is_addr(property));
172 return (const bt_bdaddr_t *)property->val;
173 }
174
property_as_device_class(const bt_property_t * property)175 const bt_device_class_t *property_as_device_class(const bt_property_t *property) {
176 assert(property_is_device_class(property));
177 return (const bt_device_class_t *)property->val;
178 }
179
property_as_device_type(const bt_property_t * property)180 bt_device_type_t property_as_device_type(const bt_property_t *property) {
181 assert(property_is_device_type(property));
182 return *(const bt_device_type_t *)property->val;
183 }
184
property_as_discovery_timeout(const bt_property_t * property)185 uint32_t property_as_discovery_timeout(const bt_property_t *property) {
186 assert(property_is_discovery_timeout(property));
187 return *(const uint32_t *)property->val;
188 }
189
property_as_name(const bt_property_t * property)190 const bt_bdname_t *property_as_name(const bt_property_t *property) {
191 assert(property_is_name(property));
192 return (const bt_bdname_t *)property->val;
193 }
194
property_as_rssi(const bt_property_t * property)195 int8_t property_as_rssi(const bt_property_t *property) {
196 assert(property_is_rssi(property));
197 return *(const int8_t *)property->val;
198 }
199
property_as_scan_mode(const bt_property_t * property)200 bt_scan_mode_t property_as_scan_mode(const bt_property_t *property) {
201 assert(property_is_scan_mode(property));
202 return *(const bt_scan_mode_t *)property->val;
203 }
204
property_as_uuids(const bt_property_t * property,size_t * count)205 const bt_uuid_t *property_as_uuids(const bt_property_t *property, size_t *count) {
206 assert(property_is_uuids(property));
207 *count = sizeof(bt_uuid_t) / property->len;
208 return (const bt_uuid_t *)property->val;
209 }
210
property_new_(void * val,size_t len,bt_property_type_t type)211 static bt_property_t *property_new_(void *val, size_t len, bt_property_type_t type) {
212 bt_property_t *property = osi_calloc(sizeof(bt_property_t));
213 assert(property != NULL);
214
215 property->val = osi_malloc(len);
216 assert(property->val != NULL);
217
218 memcpy(property->val, val, len);
219
220 property->type = type;
221 property->len = len;
222
223 return property;
224 }
225