1 /*
2 * Copyright (C) 2021 Huawei Device Co., Ltd.
3 * Licensed under the Apache License, Version 2.0 (the "License");
4 * you may not use this file except in compliance with the License.
5 * You may obtain a copy of the License at
6 *
7 * http://www.apache.org/licenses/LICENSE-2.0
8 *
9 * Unless required by applicable law or agreed to in writing, software
10 * distributed under the License is distributed on an "AS IS" BASIS,
11 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
12 * See the License for the specific language governing permissions and
13 * limitations under the License.
14 */
15
16 #include "hci_evt_info_params_cmd_complete.h"
17
18 #include <securec.h>
19
20 #include "platform/include/allocator.h"
21 #include "platform/include/list.h"
22 #include "platform/include/mutex.h"
23
24 #include "hci/cmd/hci_cmd.h"
25 #include "hci/hci.h"
26 #include "hci/hci_def.h"
27
28 #include "hci_evt.h"
29 #include "hci_evt_cmd_complete.h"
30
HciEventOnReadLocalVersionComplete(const void * param,uint8_t length)31 static void HciEventOnReadLocalVersionComplete(const void *param, uint8_t length)
32 {
33 HciReadLocalVersionInformationReturnParam returnParam = {0};
34 (void)memcpy_s(
35 &returnParam, sizeof(returnParam), param, (length > sizeof(returnParam)) ? sizeof(returnParam) : length);
36
37 HciEventCallbacks *callbacks = NULL;
38 HCI_FOREACH_EVT_CALLBACKS_START(callbacks);
39 if (callbacks->readLocalVersionInformationComplete != NULL) {
40 callbacks->readLocalVersionInformationComplete(&returnParam);
41 }
42 HCI_FOREACH_EVT_CALLBACKS_END;
43 }
44
HciEventOnReadLocalSupportedCommandsComplete(const void * param,uint8_t length)45 static void HciEventOnReadLocalSupportedCommandsComplete(const void *param, uint8_t length)
46 {
47 HciReadLocalSupportedCommandsReturnParam returnParam = {0};
48 (void)memcpy_s(
49 &returnParam, sizeof(returnParam), param, (length > sizeof(returnParam)) ? sizeof(returnParam) : length);
50
51 HciEventCallbacks *callbacks = NULL;
52 HCI_FOREACH_EVT_CALLBACKS_START(callbacks);
53 if (callbacks->readLocalSupportedCommandsComplete != NULL) {
54 callbacks->readLocalSupportedCommandsComplete(&returnParam);
55 }
56 HCI_FOREACH_EVT_CALLBACKS_END;
57 }
58
HciEventOnReadLocalSupportedFeaturesComplete(const void * param,uint8_t length)59 static void HciEventOnReadLocalSupportedFeaturesComplete(const void *param, uint8_t length)
60 {
61 HciReadLocalSupportedFeaturesReturnParam returnParam = {0};
62 (void)memcpy_s(
63 &returnParam, sizeof(returnParam), param, (length > sizeof(returnParam)) ? sizeof(returnParam) : length);
64
65 HciEventCallbacks *callbacks = NULL;
66 HCI_FOREACH_EVT_CALLBACKS_START(callbacks);
67 if (callbacks->readLocalSupportedFeaturesComplete != NULL) {
68 callbacks->readLocalSupportedFeaturesComplete(&returnParam);
69 }
70 HCI_FOREACH_EVT_CALLBACKS_END;
71 }
72
HciEventOnReadLocalExtendedFeaturesComplete(const void * param,uint8_t length)73 static void HciEventOnReadLocalExtendedFeaturesComplete(const void *param, uint8_t length)
74 {
75 HciReadLocalExtendedFeaturesReturnParam returnParam = {0};
76 (void)memcpy_s(
77 &returnParam, sizeof(returnParam), param, (length > sizeof(returnParam)) ? sizeof(returnParam) : length);
78
79 HciEventCallbacks *callbacks = NULL;
80 HCI_FOREACH_EVT_CALLBACKS_START(callbacks);
81 if (callbacks->readLocalExtendedFeaturesComplete != NULL) {
82 callbacks->readLocalExtendedFeaturesComplete(&returnParam);
83 }
84 HCI_FOREACH_EVT_CALLBACKS_END;
85 }
86
HciEventOnReadBufferSizeComplete(const void * param,uint8_t length)87 static void HciEventOnReadBufferSizeComplete(const void *param, uint8_t length)
88 {
89 HciReadBufferSizeReturnParam returnParam = {0};
90 (void)memcpy_s(
91 &returnParam, sizeof(returnParam), param, (length > sizeof(returnParam)) ? sizeof(returnParam) : length);
92
93 HciEventCallbacks *callbacks = NULL;
94 HCI_FOREACH_EVT_CALLBACKS_START(callbacks);
95 if (callbacks->readBufferSizeComplete != NULL) {
96 callbacks->readBufferSizeComplete(&returnParam);
97 }
98 HCI_FOREACH_EVT_CALLBACKS_END;
99 }
100
HciEventOnReadBdAddr(const void * param,uint8_t length)101 static void HciEventOnReadBdAddr(const void *param, uint8_t length)
102 {
103 HciReadBdAddrReturnParam returnParam = {0};
104 (void)memcpy_s(
105 &returnParam, sizeof(returnParam), param, (length > sizeof(returnParam)) ? sizeof(returnParam) : length);
106
107 HciEventCallbacks *callbacks = NULL;
108 HCI_FOREACH_EVT_CALLBACKS_START(callbacks);
109 if (callbacks->readBdAddrComplete != NULL) {
110 callbacks->readBdAddrComplete(&returnParam);
111 }
112 HCI_FOREACH_EVT_CALLBACKS_END;
113 }
114
HciCopySupportedCodecs(uint8_t * supportedCodecs,uint8_t count,const uint8_t * buf)115 static void HciCopySupportedCodecs(uint8_t *supportedCodecs, uint8_t count, const uint8_t *buf)
116 {
117 int offset = 0;
118 for (int i = 0; i < count; i++) {
119 supportedCodecs[i] = buf[offset];
120 offset += sizeof(uint8_t);
121 }
122 }
123
HciCopySupportedVendorSpecificCodecs(HciVendorSpecificCodec * vendorSpecificCodecs,uint8_t count,const uint8_t * buf)124 static void HciCopySupportedVendorSpecificCodecs(
125 HciVendorSpecificCodec *vendorSpecificCodecs, uint8_t count, const uint8_t *buf)
126 {
127 int offset = 0;
128 for (int i = 0; i < count; i++) {
129 if (memcpy_s(&vendorSpecificCodecs[i].companyID, sizeof(uint16_t), buf + offset, sizeof(uint16_t)) != EOK) {
130 return;
131 }
132 offset += sizeof(uint16_t);
133 if (memcpy_s(
134 &vendorSpecificCodecs[i].vendorDefinedCodecID, sizeof(uint16_t), buf + offset, sizeof(uint16_t)) != EOK) {
135 return;
136 }
137 offset += sizeof(uint16_t);
138 }
139 }
140
HciEventOnReadLocalSupportedCodecs(const void * param,uint8_t length)141 static void HciEventOnReadLocalSupportedCodecs(const void *param, uint8_t length)
142 {
143 uint8_t *buf = (uint8_t *)param;
144 HciReadLocalSupportedCodecsReturnParam returnParam = {0};
145 int offset = 0;
146 returnParam.status = buf[offset];
147 offset += sizeof(uint8_t);
148
149 if (offset + sizeof(uint8_t) <= length) {
150 returnParam.numberOfSupportedCodecs = buf[offset];
151 offset += sizeof(uint8_t);
152 }
153
154 if (returnParam.numberOfSupportedCodecs) {
155 if (offset + returnParam.numberOfSupportedCodecs * sizeof(uint8_t) <= length) {
156 returnParam.supportedCodecs = MEM_MALLOC.alloc(returnParam.numberOfSupportedCodecs * sizeof(uint8_t));
157 if (returnParam.supportedCodecs != NULL) {
158 HciCopySupportedCodecs(returnParam.supportedCodecs, returnParam.numberOfSupportedCodecs, buf + offset);
159 }
160 offset += returnParam.numberOfSupportedCodecs * sizeof(uint8_t);
161 } else {
162 returnParam.numberOfSupportedCodecs = 0;
163 offset = length;
164 }
165 }
166
167 if (offset + sizeof(uint8_t) <= length) {
168 returnParam.numberOfSupportedVendorSpecificCodecs = buf[offset];
169 offset += sizeof(uint8_t);
170 }
171
172 if (returnParam.numberOfSupportedVendorSpecificCodecs &&
173 (offset + returnParam.numberOfSupportedVendorSpecificCodecs * sizeof(HciVendorSpecificCodec) <= length)) {
174 returnParam.vendorSpecificCodecs =
175 MEM_MALLOC.alloc(returnParam.numberOfSupportedVendorSpecificCodecs * sizeof(HciVendorSpecificCodec));
176 if (returnParam.vendorSpecificCodecs != NULL) {
177 HciCopySupportedVendorSpecificCodecs(
178 returnParam.vendorSpecificCodecs, returnParam.numberOfSupportedVendorSpecificCodecs, buf + offset);
179 }
180 }
181
182 HciEventCallbacks *callbacks = NULL;
183 HCI_FOREACH_EVT_CALLBACKS_START(callbacks);
184 if (callbacks->readLocalSupportedCodecsComplete != NULL) {
185 callbacks->readLocalSupportedCodecsComplete(&returnParam);
186 }
187 HCI_FOREACH_EVT_CALLBACKS_END;
188
189 if (returnParam.supportedCodecs != NULL) {
190 MEM_MALLOC.free(returnParam.supportedCodecs);
191 }
192 if (returnParam.vendorSpecificCodecs != NULL) {
193 MEM_MALLOC.free(returnParam.vendorSpecificCodecs);
194 }
195 }
196
197 static HciEventCommandCompleteFunc g_informationalParametersCommandCompleteMap[] = {
198 NULL, // 0x0000
199 HciEventOnReadLocalVersionComplete, // 0x0001
200 HciEventOnReadLocalSupportedCommandsComplete, // 0x0002
201 HciEventOnReadLocalSupportedFeaturesComplete, // 0x0003
202 HciEventOnReadLocalExtendedFeaturesComplete, // 0x0004
203 HciEventOnReadBufferSizeComplete, // 0x0005
204 NULL, // 0x0006
205 NULL, // 0x0007
206 NULL, // 0x0008
207 HciEventOnReadBdAddr, // 0x0009
208 NULL, // 0x000A
209 HciEventOnReadLocalSupportedCodecs, // 0x000B
210 };
211
212 #define INFORMATIONALPARAMETERS_OCF_MAX 0x000B
213
HciEventOnInformationalParametersCommandComplete(uint16_t opCode,const void * param,uint8_t length)214 void HciEventOnInformationalParametersCommandComplete(uint16_t opCode, const void *param, uint8_t length)
215 {
216 uint16_t ocf = GET_OCF(opCode);
217 if (ocf > INFORMATIONALPARAMETERS_OCF_MAX) {
218 return;
219 }
220
221 HciEventCommandCompleteFunc func = g_informationalParametersCommandCompleteMap[ocf];
222 if (func != NULL) {
223 func(param, length);
224 }
225 }