amiro-os / unittests / periphery-lld / src / ut_alld_bq27500.c @ 8d756b18
History | View | Annotate | Download (24.52 KB)
1 | e545e620 | Thomas Schöpping | /*
|
---|---|---|---|
2 | AMiRo-OS is an operating system designed for the Autonomous Mini Robot (AMiRo) platform.
|
||
3 | 84f0ce9e | Thomas Schöpping | Copyright (C) 2016..2019 Thomas Schöpping et al.
|
4 | e545e620 | Thomas Schöpping | |
5 | This program is free software: you can redistribute it and/or modify
|
||
6 | it under the terms of the GNU General Public License as published by
|
||
7 | the Free Software Foundation, either version 3 of the License, or
|
||
8 | (at your option) any later version.
|
||
9 | |||
10 | This program is distributed in the hope that it will be useful,
|
||
11 | but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||
12 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||
13 | GNU General Public License for more details.
|
||
14 | |||
15 | You should have received a copy of the GNU General Public License
|
||
16 | along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||
17 | */
|
||
18 | |||
19 | #include <ut_alld_bq27500.h> |
||
20 | |||
21 | #if ((AMIROOS_CFG_TESTS_ENABLE == true) && defined(AMIROLLD_CFG_USE_BQ27500)) || defined(__DOXYGEN__) |
||
22 | |||
23 | #include <string.h> |
||
24 | #include <aos_debug.h> |
||
25 | #include <chprintf.h> |
||
26 | #include <aos_thread.h> |
||
27 | #include <alld_bq27500.h> |
||
28 | |||
29 | 57a5ea60 | Marc Rothmann | // change saved unseal keys to test bruteforcing
|
30 | #ifdef BQ27500_UT_TEST_BRUTEFORCE
|
||
31 | |||
32 | #ifdef BQ27500_LLD_DEFAULT_UNSEAL_KEY0
|
||
33 | #undef BQ27500_LLD_DEFAULT_UNSEAL_KEY0
|
||
34 | #define BQ27500_LLD_DEFAULT_UNSEAL_KEY0 0x1234 |
||
35 | #endif
|
||
36 | |||
37 | #ifdef BQ27500_LLD_DEFAULT_UNSEAL_KEY1
|
||
38 | #undef BQ27500_LLD_DEFAULT_UNSEAL_KEY1
|
||
39 | #define BQ27500_LLD_DEFAULT_UNSEAL_KEY1 0x5678 |
||
40 | #endif
|
||
41 | |||
42 | #endif
|
||
43 | |||
44 | bq27500_lld_control_status_t _try_unseal(BQ27500Driver* driver, uint16_t key0, uint16_t key1, apalTime_t timeout) { |
||
45 | uint16_t dst; |
||
46 | bq27500_lld_control_status_t ctrl; |
||
47 | bq27500_lld_send_ctnl_data(driver, key1, timeout); |
||
48 | aosThdUSleep(1);
|
||
49 | bq27500_lld_send_ctnl_data(driver, key0, timeout); |
||
50 | aosThdUSleep(1);
|
||
51 | bq27500_lld_sub_command_call(driver, BQ27500_LLD_SUB_CMD_CONTROL_STATUS, timeout); |
||
52 | aosThdUSleep(1);
|
||
53 | bq27500_lld_std_command(driver, BQ27500_LLD_STD_CMD_Control, &dst, timeout); |
||
54 | bq27500_lld_sub_command_read(driver, &ctrl.value, timeout); |
||
55 | return ctrl;
|
||
56 | } |
||
57 | |||
58 | uint8_t _bruteforce_sealed_key_bitflips(BaseSequentialStream* stream, BQ27500Driver* driver, uint16_t key0, uint16_t key1, apalTime_t timeout) { |
||
59 | bq27500_lld_control_status_t ctrl; |
||
60 | uint16_t k0; |
||
61 | uint16_t k1 = key1; |
||
62 | for (uint8_t i = 0; i < 16; i++) { |
||
63 | k0 = key0 ^ (1 << i); // flip bit i |
||
64 | ctrl = _try_unseal(driver, k0, k1, timeout); |
||
65 | if (ctrl.content.ss == 0x0) { |
||
66 | chprintf(stream, "\t\tSUCCESS!\n");
|
||
67 | chprintf(stream, "\t\tkey0: 0x%X, key1: 0x%X\n", k0, k1);
|
||
68 | return 1; |
||
69 | } |
||
70 | } |
||
71 | k0 = key0; |
||
72 | for (uint8_t i = 0; i < 16; i++) { |
||
73 | k1 = key1 ^ (1 << i); // flip bit i |
||
74 | ctrl = _try_unseal(driver, k0, k1, timeout); |
||
75 | if (ctrl.content.ss == 0x0) { |
||
76 | chprintf(stream, "\t\tSUCCESS!\n");
|
||
77 | chprintf(stream, "\t\tkey0: 0x%X, key1: 0x%X\n", k0, k1);
|
||
78 | return 1; |
||
79 | } |
||
80 | } |
||
81 | return 0; |
||
82 | } |
||
83 | |||
84 | void _bruteforce_sealed_key(BaseSequentialStream* stream, BQ27500Driver* driver, apalTime_t timeout) {
|
||
85 | chprintf(stream, "start bruteforcing sealed keys...\n");
|
||
86 | bq27500_lld_control_status_t ctrl; |
||
87 | uint16_t key0_reversed = 0x7236;
|
||
88 | uint16_t key1_reversed = 0x1404;
|
||
89 | uint16_t key0 = BQ27500_LLD_DEFAULT_UNSEAL_KEY0; |
||
90 | uint16_t key1 = BQ27500_LLD_DEFAULT_UNSEAL_KEY1; |
||
91 | uint16_t k0 = key0; |
||
92 | uint16_t k1 = key1; |
||
93 | |||
94 | // testing default keys in different orders
|
||
95 | chprintf(stream, "\ttry reversed byte order and different key order...\n");
|
||
96 | // default unseal keys
|
||
97 | ctrl = _try_unseal(driver, k0, k1, timeout); |
||
98 | if (ctrl.content.ss == 0x0) { |
||
99 | chprintf(stream, "\t\tSUCCESS!\n");
|
||
100 | chprintf(stream, "\t\tkey0: 0x%X, key1: 0x%X\n", k0, k1);
|
||
101 | return;
|
||
102 | } |
||
103 | // default unseal keys in reversed order
|
||
104 | ctrl = _try_unseal(driver, k1, k0, timeout); |
||
105 | if (ctrl.content.ss == 0x0) { |
||
106 | chprintf(stream, "\t\tSUCCESS!\n");
|
||
107 | chprintf(stream, "\t\tkey0: 0x%X, key1: 0x%X\n", k0, k1);
|
||
108 | return;
|
||
109 | } |
||
110 | // byte reversed keys
|
||
111 | k0 = key0_reversed; |
||
112 | k1 = key1_reversed; |
||
113 | ctrl = _try_unseal(driver, k0, k1, timeout); |
||
114 | if (ctrl.content.ss == 0x0) { |
||
115 | chprintf(stream, "\t\tSUCCESS!\n");
|
||
116 | chprintf(stream, "\t\tkey0: 0x%X, key1: 0x%X\n", k0, k1);
|
||
117 | return;
|
||
118 | } |
||
119 | // byte reversed keys in reversed order
|
||
120 | ctrl = _try_unseal(driver, k1, k0, timeout); |
||
121 | if (ctrl.content.ss == 0x0) { |
||
122 | chprintf(stream, "\t\tSUCCESS!\n");
|
||
123 | chprintf(stream, "\t\tkey0: 0x%X, key1: 0x%X\n", k0, k1);
|
||
124 | return;
|
||
125 | } |
||
126 | chprintf(stream, "\t\tfailed\n");
|
||
127 | |||
128 | |||
129 | // testing single bit flips of the default keys in different orders
|
||
130 | chprintf(stream, "\ttry single bit flips of default keys...\n");
|
||
131 | // default unseal keys
|
||
132 | uint8_t result = 0;
|
||
133 | result = _bruteforce_sealed_key_bitflips(stream, driver, key0, key1, timeout); |
||
134 | if (result == 1) { |
||
135 | return;
|
||
136 | } |
||
137 | // default unseal keys in reversed order
|
||
138 | result = _bruteforce_sealed_key_bitflips(stream, driver, key1, key0, timeout); |
||
139 | if (result == 1) { |
||
140 | return;
|
||
141 | } |
||
142 | // byte reversed keys
|
||
143 | result = _bruteforce_sealed_key_bitflips(stream, driver, key0_reversed, key1_reversed, timeout); |
||
144 | if (result == 1) { |
||
145 | return;
|
||
146 | } |
||
147 | // byte reversed keys in reversed order
|
||
148 | result = _bruteforce_sealed_key_bitflips(stream, driver, key1_reversed, key0_reversed, timeout); |
||
149 | if (result == 1) { |
||
150 | return;
|
||
151 | } |
||
152 | chprintf(stream, "\t\tfailed\n");
|
||
153 | |||
154 | |||
155 | // bruteforcing one of the keys, assuming only one of them was changed
|
||
156 | chprintf(stream, "\ttry bruteforcing a single key...\n");
|
||
157 | // default unseal key0
|
||
158 | for (uint32_t i = 0; i <= 0xFFFF; i++) { |
||
159 | ctrl = _try_unseal(driver, key0, i, timeout); |
||
160 | if (ctrl.content.ss == 0x0) { |
||
161 | chprintf(stream, "\t\tSUCCESS!\n");
|
||
162 | chprintf(stream, "\t\tkey0: 0x%X, key1: 0x%X\n", key0, i);
|
||
163 | return;
|
||
164 | } |
||
165 | } |
||
166 | chprintf(stream, "\t\tkey failed. 1/8\n");
|
||
167 | // reversed unseal key0
|
||
168 | for (uint32_t i = 0; i <= 0xFFFF; i++) { |
||
169 | ctrl = _try_unseal(driver, key0_reversed, i, timeout); |
||
170 | if (ctrl.content.ss == 0x0) { |
||
171 | chprintf(stream, "\t\tSUCCESS!\n");
|
||
172 | chprintf(stream, "\t\tkey0: 0x%X, key1: 0x%X\n", key0_reversed, i);
|
||
173 | return;
|
||
174 | } |
||
175 | } |
||
176 | chprintf(stream, "\t\tkey failed. 2/8\n");
|
||
177 | // default unseal key0 in reversed order
|
||
178 | for (uint32_t i = 0; i <= 0xFFFF; i++) { |
||
179 | ctrl = _try_unseal(driver, i, key0, timeout); |
||
180 | if (ctrl.content.ss == 0x0) { |
||
181 | chprintf(stream, "\t\tSUCCESS!\n");
|
||
182 | chprintf(stream, "\t\tkey0: 0x%X, key1: 0x%X\n", i, key0);
|
||
183 | return;
|
||
184 | } |
||
185 | } |
||
186 | chprintf(stream, "\t\tkey failed. 3/8\n");
|
||
187 | // reversed unseal key0 in reversed order
|
||
188 | for (uint32_t i = 0; i <= 0xFFFF; i++) { |
||
189 | ctrl = _try_unseal(driver, i, key0_reversed, timeout); |
||
190 | if (ctrl.content.ss == 0x0) { |
||
191 | chprintf(stream, "\t\tSUCCESS!\n");
|
||
192 | chprintf(stream, "\t\tkey0: 0x%X, key1: 0x%X\n", i, key0_reversed);
|
||
193 | return;
|
||
194 | } |
||
195 | } |
||
196 | chprintf(stream, "\t\tkey failed. 4/8\n");
|
||
197 | // default unseal key1
|
||
198 | for (uint32_t i = 0; i <= 0xFFFF; i++) { |
||
199 | ctrl = _try_unseal(driver, i, key1, timeout); |
||
200 | if (ctrl.content.ss == 0x0) { |
||
201 | chprintf(stream, "\t\tSUCCESS!\n");
|
||
202 | chprintf(stream, "\t\tkey0: 0x%X, key1: 0x%X\n", i, key1);
|
||
203 | return;
|
||
204 | } |
||
205 | } |
||
206 | chprintf(stream, "\t\tkey failed. 5/8\n");
|
||
207 | // reversed unseal key1
|
||
208 | for (uint32_t i = 0; i <= 0xFFFF; i++) { |
||
209 | ctrl = _try_unseal(driver, i, key1_reversed, timeout); |
||
210 | if (ctrl.content.ss == 0x0) { |
||
211 | chprintf(stream, "\t\tSUCCESS!\n");
|
||
212 | chprintf(stream, "\t\tkey0: 0x%X, key1: 0x%X\n", i, key1_reversed);
|
||
213 | return;
|
||
214 | } |
||
215 | } |
||
216 | chprintf(stream, "\t\tkey failed. 6/8\n");
|
||
217 | // default unseal key1 in reversed order
|
||
218 | for (uint32_t i = 0; i <= 0xFFFF; i++) { |
||
219 | ctrl = _try_unseal(driver, key1, i, timeout); |
||
220 | if (ctrl.content.ss == 0x0) { |
||
221 | chprintf(stream, "\t\tSUCCESS!\n");
|
||
222 | chprintf(stream, "\t\tkey0: 0x%X, key1: 0x%X\n", key1, i);
|
||
223 | return;
|
||
224 | } |
||
225 | } |
||
226 | chprintf(stream, "\t\tkey failed. 7/8\n");
|
||
227 | // reversed unseal key1 in reversed order
|
||
228 | for (uint32_t i = 0; i <= 0xFFFF; i++) { |
||
229 | ctrl = _try_unseal(driver, key1_reversed, i, timeout); |
||
230 | if (ctrl.content.ss == 0x0) { |
||
231 | chprintf(stream, "\t\tSUCCESS!\n");
|
||
232 | chprintf(stream, "\t\tkey0: 0x%X, key1: 0x%X\n", key1_reversed, i);
|
||
233 | return;
|
||
234 | } |
||
235 | } |
||
236 | chprintf(stream, "\t\tkey failed. 8/8\n");
|
||
237 | chprintf(stream, "\t\tfailed\n");
|
||
238 | |||
239 | |||
240 | // full bruteforce
|
||
241 | chprintf(stream, "\tbruteforcing both keys...\t");
|
||
242 | for (uint32_t i = 0; i <= 0xFFFF; i++) { |
||
243 | chprintf(stream, "\t\ti: %u\n", i);
|
||
244 | for (uint32_t j = 0; j <= 0xFFFF; j++) { |
||
245 | ctrl = _try_unseal(driver, i, j, timeout); |
||
246 | if (ctrl.content.ss == 0x0) { |
||
247 | chprintf(stream, "\t\tSUCCESS!\n");
|
||
248 | chprintf(stream, "\t\tkey0: 0x%X, key1: 0x%X\n", i, j);
|
||
249 | return;
|
||
250 | } |
||
251 | } |
||
252 | } |
||
253 | |||
254 | chprintf(stream, "\t\tfailed, no keys could be found");
|
||
255 | } |
||
256 | |||
257 | e545e620 | Thomas Schöpping | aos_utresult_t utAlldBq27500Func(BaseSequentialStream* stream, aos_unittest_t* ut) |
258 | { |
||
259 | aosDbgCheck(ut->data != NULL && ((ut_bq27500data_t*)(ut->data))->driver != NULL); |
||
260 | |||
261 | // local variables
|
||
262 | aos_utresult_t result = {0, 0}; |
||
263 | uint32_t status; |
||
264 | bq27500_lld_batlow_t bl; |
||
265 | bq27500_lld_batgood_t bg; |
||
266 | uint16_t dst; |
||
267 | bq27500_lld_flags_t flags; |
||
268 | uint16_t subdata = 0;
|
||
269 | uint8_t original_length; |
||
270 | char original_name[8+1]; |
||
271 | uint8_t val = 0x00;
|
||
272 | uint8_t block[32];
|
||
273 | char new_name[] = "test"; |
||
274 | uint8_t new_lenght; |
||
275 | char name[8+1] = {'\0'}; |
||
276 | uint8_t sum = 0;
|
||
277 | bool success;
|
||
278 | bool success2;
|
||
279 | |||
280 | chprintf(stream, "read battery low gpio...\n");
|
||
281 | status = bq27500_lld_read_batlow(((ut_bq27500data_t*)ut->data)->driver, &bl); |
||
282 | chprintf(stream, "\t\tbattery low: 0x%X\n", bl);
|
||
283 | if (status == APAL_STATUS_SUCCESS) {
|
||
284 | aosUtPassed(stream, &result); |
||
285 | } else {
|
||
286 | aosUtFailedMsg(stream, &result, "0x%08X\n", status);
|
||
287 | } |
||
288 | |||
289 | chprintf(stream, "read battery good gpio...\n");
|
||
290 | status = bq27500_lld_read_batgood(((ut_bq27500data_t*)ut->data)->driver, &bg); |
||
291 | chprintf(stream, "\t\tbattery good: 0x%X\n", bg);
|
||
292 | if (status == APAL_STATUS_SUCCESS) {
|
||
293 | aosUtPassed(stream, &result); |
||
294 | } else {
|
||
295 | aosUtFailedMsg(stream, &result, "0x%08X\n", status);
|
||
296 | } |
||
297 | |||
298 | chprintf(stream, "std command FLAGS...\n");
|
||
299 | status = bq27500_lld_std_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_STD_CMD_Flags, &flags.value, ((ut_bq27500data_t*)ut->data)->timeout); |
||
300 | chprintf(stream, "\t\tflags: 0x%04X\n", flags.value);
|
||
301 | chprintf(stream, "\t\tbattery detected: 0x%X\n", flags.content.bat_det);
|
||
302 | chprintf(stream, "\t\tbattery fully charged: 0x%X\n", flags.content.fc);
|
||
303 | if (status == APAL_STATUS_SUCCESS) {
|
||
304 | aosUtPassed(stream, &result); |
||
305 | } else {
|
||
306 | aosUtFailedMsg(stream, &result, "0x%08X\n", status);
|
||
307 | } |
||
308 | |||
309 | chprintf(stream, "std command CTNL...\n");
|
||
310 | status = bq27500_lld_std_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_STD_CMD_Control, &dst, ((ut_bq27500data_t*)ut->data)->timeout); |
||
311 | if (status == APAL_STATUS_SUCCESS) {
|
||
312 | aosUtPassed(stream, &result); |
||
313 | } else {
|
||
314 | aosUtFailedMsg(stream, &result, "0x%08X\n", status);
|
||
315 | } |
||
316 | |||
317 | chprintf(stream, "sub command: CTRL Status...\n");
|
||
318 | 57a5ea60 | Marc Rothmann | aosThdUSleep(1);
|
319 | e545e620 | Thomas Schöpping | status = bq27500_lld_sub_command_call(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_SUB_CMD_CONTROL_STATUS, ((ut_bq27500data_t*)ut->data)->timeout); |
320 | 57a5ea60 | Marc Rothmann | aosThdUSleep(1);
|
321 | e545e620 | Thomas Schöpping | status |= bq27500_lld_std_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_STD_CMD_Control, &dst, ((ut_bq27500data_t*)ut->data)->timeout); |
322 | 57a5ea60 | Marc Rothmann | aosThdUSleep(1);
|
323 | e545e620 | Thomas Schöpping | bq27500_lld_control_status_t ctrl; |
324 | status |= bq27500_lld_sub_command_read(((ut_bq27500data_t*)ut->data)->driver, &ctrl.value, ((ut_bq27500data_t*)ut->data)->timeout); |
||
325 | chprintf(stream, "\t\tdst: 0x%X\n", ctrl.value);
|
||
326 | chprintf(stream, "\t\tsleep: 0x%X\n", ctrl.content.sleep);
|
||
327 | chprintf(stream, "\t\thibernate: 0x%X\n", ctrl.content.hibernate);
|
||
328 | if (status == APAL_STATUS_SUCCESS) {
|
||
329 | aosUtPassed(stream, &result); |
||
330 | } else {
|
||
331 | aosUtFailedMsg(stream, &result, "0x%08X\n", status);
|
||
332 | } |
||
333 | |||
334 | chprintf(stream, "sub command: firmware version...\n");
|
||
335 | status = bq27500_lld_sub_command_call(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_SUB_CMD_FW_VERSION, ((ut_bq27500data_t*)ut->data)->timeout); |
||
336 | aosThdMSleep(1);
|
||
337 | bq27500_lld_version_t version; |
||
338 | status |= bq27500_lld_sub_command_read(((ut_bq27500data_t*)ut->data)->driver, &version.value, ((ut_bq27500data_t*)ut->data)->timeout); |
||
339 | chprintf(stream, "\t\tfirmware version: %X%X-%X%X\n", version.content.major_high, version.content.major_low, version.content.minor_high, version.content.minor_low);
|
||
340 | if (status == APAL_STATUS_SUCCESS) {
|
||
341 | aosUtPassed(stream, &result); |
||
342 | } else {
|
||
343 | aosUtFailedMsg(stream, &result, "0x%08X\n", status);
|
||
344 | } |
||
345 | |||
346 | chprintf(stream, "sub command: hardware version...\n");
|
||
347 | status = bq27500_lld_sub_command_call(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_SUB_CMD_HW_VERSION, ((ut_bq27500data_t*)ut->data)->timeout); |
||
348 | aosThdMSleep(1);
|
||
349 | status |= bq27500_lld_sub_command_read(((ut_bq27500data_t*)ut->data)->driver, &version.value, ((ut_bq27500data_t*)ut->data)->timeout); |
||
350 | chprintf(stream, "\t\thardware version: %X%X-%X%X\n", version.content.major_high, version.content.major_low, version.content.minor_high, version.content.minor_low);
|
||
351 | if (status == APAL_STATUS_SUCCESS) {
|
||
352 | aosUtPassed(stream, &result); |
||
353 | } else {
|
||
354 | aosUtFailedMsg(stream, &result, "0x%08X\n", status);
|
||
355 | } |
||
356 | |||
357 | chprintf(stream, "ext command: device name length...\n");
|
||
358 | status = bq27500_lld_ext_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_EXT_CMD_DeviceNameLength, BQ27500_LLD_EXT_CMD_READ, &original_length, 1, 0, ((ut_bq27500data_t*)ut->data)->timeout); |
||
359 | chprintf(stream, "\t\tdevice name length: %d \n", original_length);
|
||
360 | if (status == APAL_STATUS_SUCCESS && original_length <= 8) { |
||
361 | aosUtPassed(stream, &result); |
||
362 | } else {
|
||
363 | aosUtFailedMsg(stream, &result, "0x%08X\n", status);
|
||
364 | original_length = 8;
|
||
365 | } |
||
366 | |||
367 | chprintf(stream, "ext command: device name (read)...\n");
|
||
368 | status = bq27500_lld_ext_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_EXT_CMD_DeviceName, BQ27500_LLD_EXT_CMD_READ, (uint8_t*)original_name, original_length, 0, ((ut_bq27500data_t*)ut->data)->timeout);
|
||
369 | original_name[original_length] = '\0';
|
||
370 | chprintf(stream, "\t\tdevice name: %s\n", original_name);
|
||
371 | if (status == APAL_STATUS_SUCCESS) {
|
||
372 | aosUtPassed(stream, &result); |
||
373 | } else {
|
||
374 | aosUtFailedMsg(stream, &result, "0x%08X\n", status);
|
||
375 | } |
||
376 | |||
377 | chprintf(stream, "battery info std commands...\n");
|
||
378 | status = bq27500_lld_std_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_STD_CMD_Temperatur, &dst, ((ut_bq27500data_t*)ut->data)->timeout); |
||
379 | chprintf(stream, "\t\ttemperature: %fK (%fC) \n", (float)dst/10.0f, (float)dst/10.0f-273.5f); |
||
380 | status |= bq27500_lld_std_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_STD_CMD_FullAvailableCapacity, &dst, ((ut_bq27500data_t*)ut->data)->timeout); |
||
381 | chprintf(stream, "\t\tfull available capacity: %umAh \n", dst);
|
||
382 | status |= bq27500_lld_std_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_STD_CMD_FullChargeCapacity, &dst, ((ut_bq27500data_t*)ut->data)->timeout); |
||
383 | chprintf(stream, "\t\tfull charge capacity: %umAh \n", dst);
|
||
384 | status |= bq27500_lld_std_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_STD_CMD_RemainingCapacity, &dst, ((ut_bq27500data_t*)ut->data)->timeout); |
||
385 | chprintf(stream, "\t\tremaining capacity: %umAh \n", dst);
|
||
386 | status |= bq27500_lld_std_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_STD_CMD_Voltage, &dst, ((ut_bq27500data_t*)ut->data)->timeout); |
||
387 | chprintf(stream, "\t\tvoltage: %umV \n", dst);
|
||
388 | status |= bq27500_lld_std_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_STD_CMD_AverageCurrent, &dst, ((ut_bq27500data_t*)ut->data)->timeout); |
||
389 | chprintf(stream, "\t\taverage current: %dmA \n", (int8_t)dst);
|
||
390 | status |= bq27500_lld_std_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_STD_CMD_AveragePower, &dst, ((ut_bq27500data_t*)ut->data)->timeout); |
||
391 | chprintf(stream, "\t\taverage power: %dmW \n", (int8_t)dst);
|
||
392 | status |= bq27500_lld_std_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_STD_CMD_TimeToFull, &dst, ((ut_bq27500data_t*)ut->data)->timeout); |
||
393 | if (dst != (uint16_t)~0) { |
||
394 | chprintf(stream, "\t\ttime to full: %umin \n", dst);
|
||
395 | } else {
|
||
396 | chprintf(stream, "\t\ttime to full: (not charging) \n", dst);
|
||
397 | } |
||
398 | status |= bq27500_lld_std_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_STD_CMD_TimeToEmpty, &dst, ((ut_bq27500data_t*)ut->data)->timeout); |
||
399 | if (dst != (uint16_t)~0) { |
||
400 | chprintf(stream, "\t\ttime to empty: %umin \n", dst);
|
||
401 | } else {
|
||
402 | chprintf(stream, "\t\ttime to empty: (not discharging) \n", dst);
|
||
403 | } |
||
404 | if (status == APAL_STATUS_SUCCESS) {
|
||
405 | aosUtPassed(stream, &result); |
||
406 | } else {
|
||
407 | aosUtFailedMsg(stream, &result, "0x%08X\n", status);
|
||
408 | } |
||
409 | |||
410 | chprintf(stream, "check sealed state...\n");
|
||
411 | status = bq27500_lld_std_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_STD_CMD_Control, &dst, ((ut_bq27500data_t*)ut->data)->timeout); |
||
412 | status |= bq27500_lld_sub_command_call(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_SUB_CMD_CONTROL_STATUS, ((ut_bq27500data_t*)ut->data)->timeout); |
||
413 | aosThdMSleep(1);
|
||
414 | status |= bq27500_lld_sub_command_read(((ut_bq27500data_t*)ut->data)->driver, &ctrl.value, ((ut_bq27500data_t*)ut->data)->timeout); |
||
415 | chprintf(stream, "\t\tsealed: 0x%X\n", ctrl.content.ss);
|
||
416 | chprintf(stream, "\t\tfull access sealed: 0x%X\n", ctrl.content.fas);
|
||
417 | if (status == APAL_STATUS_SUCCESS) {
|
||
418 | aosUtPassed(stream, &result); |
||
419 | } else {
|
||
420 | aosUtFailedMsg(stream, &result, "0x%08X\n", status);
|
||
421 | } |
||
422 | |||
423 | chprintf(stream, "unseale...\n");
|
||
424 | status = bq27500_lld_send_ctnl_data(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_DEFAULT_UNSEAL_KEY1, ((ut_bq27500data_t*)ut->data)->timeout); |
||
425 | 57a5ea60 | Marc Rothmann | aosThdMSleep(1);
|
426 | e545e620 | Thomas Schöpping | status |= bq27500_lld_send_ctnl_data(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_DEFAULT_UNSEAL_KEY0, ((ut_bq27500data_t*)ut->data)->timeout); |
427 | 57a5ea60 | Marc Rothmann | aosThdMSleep(1);
|
428 | e545e620 | Thomas Schöpping | status |= bq27500_lld_sub_command_call(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_SUB_CMD_CONTROL_STATUS, ((ut_bq27500data_t*)ut->data)->timeout); |
429 | 57a5ea60 | Marc Rothmann | aosThdMSleep(1);
|
430 | e545e620 | Thomas Schöpping | status |= bq27500_lld_std_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_STD_CMD_Control, &dst, ((ut_bq27500data_t*)ut->data)->timeout); |
431 | status |= bq27500_lld_sub_command_read(((ut_bq27500data_t*)ut->data)->driver, &ctrl.value, ((ut_bq27500data_t*)ut->data)->timeout); |
||
432 | if (status == APAL_STATUS_SUCCESS && ctrl.content.ss == 0x0) { |
||
433 | aosUtPassed(stream, &result); |
||
434 | } else {
|
||
435 | aosUtFailedMsg(stream, &result, "0x%08X\n", status);
|
||
436 | 57a5ea60 | Marc Rothmann | _bruteforce_sealed_key(stream, ((ut_bq27500data_t*)ut->data)->driver, ((ut_bq27500data_t*)ut->data)->timeout); |
437 | e545e620 | Thomas Schöpping | } |
438 | |||
439 | chprintf(stream, "read device name from data flash...\n");
|
||
440 | status = bq27500_lld_ext_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_EXT_CMD_BlockDataControl, BQ27500_LLD_EXT_CMD_WRITE, &val, 1, 0, ((ut_bq27500data_t*)ut->data)->timeout); |
||
441 | aosThdMSleep(50);
|
||
442 | val = 0x30;
|
||
443 | status |= bq27500_lld_ext_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_EXT_CMD_DataFlashClass, BQ27500_LLD_EXT_CMD_WRITE, &val, 1, 0, ((ut_bq27500data_t*)ut->data)->timeout); |
||
444 | aosThdMSleep(50);
|
||
445 | val = 0;
|
||
446 | status |= bq27500_lld_ext_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_EXT_CMD_DataFlashBlock, BQ27500_LLD_EXT_CMD_WRITE, &val, 1, 0, ((ut_bq27500data_t*)ut->data)->timeout); |
||
447 | aosThdMSleep(50);
|
||
448 | status |= bq27500_lld_ext_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_EXT_CMD_BlockData, BQ27500_LLD_EXT_CMD_READ, (uint8_t*)block, original_length, 13, ((ut_bq27500data_t*)ut->data)->timeout);
|
||
449 | block[original_length] = '\0';
|
||
450 | chprintf(stream, "\t\tdevice name: %s\n", block);
|
||
451 | if (status == APAL_STATUS_SUCCESS && (strcmp((char*)block, (char*)original_name) == 0)) { |
||
452 | aosUtPassed(stream, &result); |
||
453 | } else {
|
||
454 | chprintf(stream, "\t\tread data: ");
|
||
455 | for (uint8_t blockIdx = 0; blockIdx < original_length; blockIdx++) { |
||
456 | chprintf(stream, "0x%02X\n", block[blockIdx]);
|
||
457 | } |
||
458 | aosUtFailedMsg(stream, &result, "0x%08X\n", status);
|
||
459 | } |
||
460 | |||
461 | chprintf(stream, "change device name in data flash to \"test\"...\n");
|
||
462 | status = bq27500_lld_ext_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_EXT_CMD_BlockData, BQ27500_LLD_EXT_CMD_WRITE, (uint8_t*)new_name, 5, 13, ((ut_bq27500data_t*)ut->data)->timeout); |
||
463 | aosThdMSleep(50);
|
||
464 | status |= bq27500_lld_ext_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_EXT_CMD_BlockData, BQ27500_LLD_EXT_CMD_READ, (uint8_t*)block, 32, 0, ((ut_bq27500data_t*)ut->data)->timeout); |
||
465 | // compute blockdata checksum
|
||
466 | status |= bq27500_lld_compute_blockdata_checksum(block, &sum); |
||
467 | // write checksum to BlockDataChecksum, triggering the write of BlackData
|
||
468 | status |= bq27500_lld_ext_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_EXT_CMD_BlockDataCheckSum, BQ27500_LLD_EXT_CMD_WRITE, &sum, 1, 0, ((ut_bq27500data_t*)ut->data)->timeout); |
||
469 | aosThdMSleep(50);
|
||
470 | status |= bq27500_lld_ext_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_EXT_CMD_DeviceNameLength, BQ27500_LLD_EXT_CMD_READ, &new_lenght, 1, 0, ((ut_bq27500data_t*)ut->data)->timeout); |
||
471 | aosThdMSleep(50);
|
||
472 | // read out device name, to see if changing it was successfull
|
||
473 | status |= bq27500_lld_ext_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_EXT_CMD_DeviceName, BQ27500_LLD_EXT_CMD_READ, (uint8_t*)name, new_lenght, 0, ((ut_bq27500data_t*)ut->data)->timeout);
|
||
474 | name[new_lenght] = '\0';
|
||
475 | chprintf(stream, "\t\tdevice name: %s\n", name);
|
||
476 | success = (strcmp(name, new_name) == 0);
|
||
477 | |||
478 | // change device name back to original name
|
||
479 | val = 0x00;
|
||
480 | status = bq27500_lld_ext_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_EXT_CMD_BlockDataControl, BQ27500_LLD_EXT_CMD_WRITE, &val, 1, 0, ((ut_bq27500data_t*)ut->data)->timeout); |
||
481 | aosThdMSleep(50);
|
||
482 | val = 0x30;
|
||
483 | status |= bq27500_lld_ext_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_EXT_CMD_DataFlashClass, BQ27500_LLD_EXT_CMD_WRITE, &val, 1, 0, ((ut_bq27500data_t*)ut->data)->timeout); |
||
484 | aosThdMSleep(50);
|
||
485 | val = 0;
|
||
486 | status |= bq27500_lld_ext_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_EXT_CMD_DataFlashBlock, BQ27500_LLD_EXT_CMD_WRITE, &val, 1, 0, ((ut_bq27500data_t*)ut->data)->timeout); |
||
487 | aosThdMSleep(50);
|
||
488 | status |= bq27500_lld_ext_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_EXT_CMD_BlockData, BQ27500_LLD_EXT_CMD_WRITE, (uint8_t*)original_name, 7, 13, ((ut_bq27500data_t*)ut->data)->timeout); |
||
489 | aosThdMSleep(50);
|
||
490 | status |= bq27500_lld_ext_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_EXT_CMD_BlockData, BQ27500_LLD_EXT_CMD_READ, (uint8_t*)block, 32, 0, ((ut_bq27500data_t*)ut->data)->timeout); |
||
491 | // compute blockdata checksum
|
||
492 | sum = 0;
|
||
493 | status |= bq27500_lld_compute_blockdata_checksum(block, &sum); |
||
494 | // write checksum to BlockDataChecksum, triggering the write of BlackData
|
||
495 | status |= bq27500_lld_ext_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_EXT_CMD_BlockDataCheckSum, BQ27500_LLD_EXT_CMD_WRITE, &sum, 1, 0, ((ut_bq27500data_t*)ut->data)->timeout); |
||
496 | aosThdMSleep(1000);
|
||
497 | status |= bq27500_lld_ext_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_EXT_CMD_DeviceNameLength, BQ27500_LLD_EXT_CMD_READ, &original_length, 1, 0, ((ut_bq27500data_t*)ut->data)->timeout); |
||
498 | aosThdMSleep(50);
|
||
499 | // read device name, to see if changing it back to the original name was successfull
|
||
500 | status |= bq27500_lld_ext_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_EXT_CMD_DeviceName, BQ27500_LLD_EXT_CMD_READ, (uint8_t*)name, original_length, 0, ((ut_bq27500data_t*)ut->data)->timeout);
|
||
501 | success2 = (strcmp(name, original_name) == 0);
|
||
502 | name[original_length] = '\0';
|
||
503 | chprintf(stream, "\t\tchanged back to name: %s, original_name: %s\n", name, original_name);
|
||
504 | if (status == APAL_STATUS_OK && ((success && success2) || (ctrl.content.sleep == 0))) { |
||
505 | aosUtPassed(stream, &result); |
||
506 | } else {
|
||
507 | aosUtFailedMsg(stream, &result, "0x%08X, changing: 0x%X - changing back: 0x%X\n", status, success, success2);
|
||
508 | } |
||
509 | |||
510 | chprintf(stream, "seal...\n");
|
||
511 | status = bq27500_lld_std_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_STD_CMD_Control, &dst, ((ut_bq27500data_t*)ut->data)->timeout); |
||
512 | aosThdMSleep(50);
|
||
513 | status |= bq27500_lld_sub_command_call(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_SUB_CMD_SEALED, ((ut_bq27500data_t*)ut->data)->timeout); |
||
514 | aosThdMSleep(50);
|
||
515 | status |= bq27500_lld_std_command(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_STD_CMD_Control, &dst, ((ut_bq27500data_t*)ut->data)->timeout); |
||
516 | aosThdMSleep(50);
|
||
517 | status |= bq27500_lld_sub_command_call(((ut_bq27500data_t*)ut->data)->driver, BQ27500_LLD_SUB_CMD_CONTROL_STATUS, ((ut_bq27500data_t*)ut->data)->timeout); |
||
518 | aosThdMSleep(50);
|
||
519 | status |= bq27500_lld_sub_command_read(((ut_bq27500data_t*)ut->data)->driver, &ctrl.value, ((ut_bq27500data_t*)ut->data)->timeout); |
||
520 | if (status == APAL_STATUS_SUCCESS && ctrl.content.ss == 0x1) { |
||
521 | aosUtPassed(stream, &result); |
||
522 | } else {
|
||
523 | chprintf(stream, "\tfailed (0x%X)\n", status);
|
||
524 | aosUtFailedMsg(stream, &result, "0x%08X, ctrl 0x%X\n", status, subdata);
|
||
525 | ++result.failed; |
||
526 | } |
||
527 | |||
528 | aosUtInfoMsg(stream,"driver object memory footprint: %u bytes\n", sizeof(BQ27500Driver)); |
||
529 | |||
530 | return result;
|
||
531 | } |
||
532 | |||
533 | #endif /* (AMIROOS_CFG_TESTS_ENABLE == true) && defined(AMIROLLD_CFG_USE_BQ27500) */ |