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