/test/periphery-lld/bq27500_v1/aos_test_bq27500.c - Annotate - AMiRo-OS - Research for Cognitive Interaction

amiro-os / test / periphery-lld / bq27500_v1 / aos_test_bq27500.c @ 4c72a54c

History | View | Annotate | Download (27.053 KB)

-            e545e620
+/*
 AMiRo-OS is an operating system designed for the Autonomous Mini Robot (AMiRo) platform.
-f0ce9e
+Copyright (C) 2016..2019  Thomas Schöpping et al.
-            e545e620
+            Thomas Schöpping
 This program is free software: you can redistribute it and/or modify
 it under the terms of the GNU General Public License as published by
 the Free Software Foundation, either version 3 of the License, or
 (at your option) any later version.
 This program is distributed in the hope that it will be useful,
 but WITHOUT ANY WARRANTY; without even the implied warranty of
 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 GNU General Public License for more details.
 You should have received a copy of the GNU General Public License
 along with this program.  If not, see <http://www.gnu.org/licenses/>.
 */
-            ddf34c3d
+#include <amiroos.h>
-c72a54c
+#include <aos_test_bq27500.h>
-            e545e620
+            Thomas Schöpping
-c72a54c
+#if (AMIROOS_CFG_TESTS_ENABLE == true) || defined(__DOXYGEN__)
-            e545e620
+            Thomas Schöpping
 #include <string.h>
-            f3ac1c96
+            Thomas Schöpping
 /******************************************************************************/
 /* LOCAL DEFINITIONS                                                          */
 /******************************************************************************/
-            e545e620
+            Thomas Schöpping
-a5ea60
+// change saved unseal keys to test bruteforcing
-c72a54c
+#if defined(BQ27500_TEST_BRUTEFORCE)
-a5ea60
+            Marc Rothmann
-de0cc90
+#if defined(BQ27500_LLD_DEFAULT_UNSEAL_KEY0)
-a5ea60
+#undef BQ27500_LLD_DEFAULT_UNSEAL_KEY0
 #define BQ27500_LLD_DEFAULT_UNSEAL_KEY0 0x1234
-de0cc90
+#endif /* defined(BQ27500_LLD_DEFAULT_UNSEAL_KEY0) */
-a5ea60
+            Marc Rothmann
-de0cc90
+#if defined(BQ27500_LLD_DEFAULT_UNSEAL_KEY1)
-a5ea60
+#undef BQ27500_LLD_DEFAULT_UNSEAL_KEY1
 #define BQ27500_LLD_DEFAULT_UNSEAL_KEY1 0x5678
-de0cc90
+#endif /* defined(BQ27500_LLD_DEFAULT_UNSEAL_KEY1) */
-a5ea60
+            Marc Rothmann
-c72a54c
+#endif /* defined(BQ27500_TEST_BRUTEFORCE) */
-a5ea60
+            Marc Rothmann
-            f3ac1c96
+/******************************************************************************/
 /* EXPORTED VARIABLES                                                         */
 /******************************************************************************/
 /******************************************************************************/
 /* LOCAL TYPES                                                                */
 /******************************************************************************/
 /******************************************************************************/
 /* LOCAL VARIABLES                                                            */
 /******************************************************************************/
 /******************************************************************************/
 /* LOCAL FUNCTIONS                                                            */
 /******************************************************************************/
-a5ea60
+bq27500_lld_control_status_t _try_unseal(BQ27500Driver* driver, uint16_t key0, uint16_t key1, apalTime_t timeout) {
   uint16_t dst;
   bq27500_lld_control_status_t ctrl;
   bq27500_lld_send_ctnl_data(driver, key1, timeout);
   aosThdUSleep(1);
   bq27500_lld_send_ctnl_data(driver, key0, timeout);
   aosThdUSleep(1);
   bq27500_lld_sub_command_call(driver, BQ27500_LLD_SUB_CMD_CONTROL_STATUS, timeout);
   aosThdUSleep(1);
   bq27500_lld_std_command(driver, BQ27500_LLD_STD_CMD_Control, &dst, timeout);
   bq27500_lld_sub_command_read(driver, &ctrl.value, timeout);
   return ctrl;
+}
 uint8_t _bruteforce_sealed_key_bitflips(BaseSequentialStream* stream, BQ27500Driver* driver, uint16_t key0, uint16_t key1, apalTime_t timeout) {
   bq27500_lld_control_status_t ctrl;
   uint16_t k0;
   uint16_t k1 = key1;
   for (uint8_t i = 0; i < 16; i++) {
     k0 = key0 ^ (1 << i); // flip bit i
     ctrl = _try_unseal(driver, k0, k1, timeout);
     if (ctrl.content.ss == 0x0) {
       chprintf(stream, "\t\tSUCCESS!\n");
       chprintf(stream, "\t\tkey0: 0x%X, key1: 0x%X\n", k0, k1);
       return 1;
+    }
+  }
   k0 = key0;
   for (uint8_t i = 0; i < 16; i++) {
     k1 = key1 ^ (1 << i); // flip bit i
     ctrl = _try_unseal(driver, k0, k1, timeout);
     if (ctrl.content.ss == 0x0) {
       chprintf(stream, "\t\tSUCCESS!\n");
       chprintf(stream, "\t\tkey0: 0x%X, key1: 0x%X\n", k0, k1);
       return 1;
+    }
+  }
   return 0;
+}
 void _bruteforce_sealed_key(BaseSequentialStream* stream, BQ27500Driver* driver, apalTime_t timeout) {
   chprintf(stream, "start bruteforcing sealed keys...\n");
   bq27500_lld_control_status_t ctrl;
   uint16_t key0_reversed = 0x7236;
   uint16_t key1_reversed = 0x1404;
   uint16_t key0 = BQ27500_LLD_DEFAULT_UNSEAL_KEY0;
   uint16_t key1 = BQ27500_LLD_DEFAULT_UNSEAL_KEY1;
   uint16_t k0 = key0;
   uint16_t k1 = key1;
   // testing default keys in different orders
   chprintf(stream, "\ttry reversed byte order and different key order...\n");
   // default unseal keys
   ctrl = _try_unseal(driver, k0, k1, timeout);
   if (ctrl.content.ss == 0x0) {
     chprintf(stream, "\t\tSUCCESS!\n");
     chprintf(stream, "\t\tkey0: 0x%X, key1: 0x%X\n", k0, k1);
     return;
+  }
   // default unseal keys in reversed order
   ctrl = _try_unseal(driver, k1, k0, timeout);
   if (ctrl.content.ss == 0x0) {
     chprintf(stream, "\t\tSUCCESS!\n");
     chprintf(stream, "\t\tkey0: 0x%X, key1: 0x%X\n", k0, k1);
     return;
+  }
   // byte reversed keys
   k0 = key0_reversed;
   k1 = key1_reversed;
   ctrl = _try_unseal(driver, k0, k1, timeout);
   if (ctrl.content.ss == 0x0) {
     chprintf(stream, "\t\tSUCCESS!\n");
     chprintf(stream, "\t\tkey0: 0x%X, key1: 0x%X\n", k0, k1);
     return;
+  }
   // byte reversed keys in reversed order
   ctrl = _try_unseal(driver, k1, k0, timeout);
   if (ctrl.content.ss == 0x0) {
     chprintf(stream, "\t\tSUCCESS!\n");
     chprintf(stream, "\t\tkey0: 0x%X, key1: 0x%X\n", k0, k1);
     return;
+  }
   chprintf(stream, "\t\tfailed\n");
   // testing single bit flips of the default keys in different orders
   chprintf(stream, "\ttry single bit flips of default keys...\n");
   // default unseal keys
   uint8_t result = 0;
   result = _bruteforce_sealed_key_bitflips(stream, driver, key0, key1, timeout);
   if (result == 1) {
     return;
+  }
   // default unseal keys in reversed order
   result = _bruteforce_sealed_key_bitflips(stream, driver, key1, key0, timeout);
   if (result == 1) {
     return;
+  }
   // byte reversed keys
   result = _bruteforce_sealed_key_bitflips(stream, driver, key0_reversed, key1_reversed, timeout);
   if (result == 1) {
     return;
+  }
   // byte reversed keys in reversed order
   result = _bruteforce_sealed_key_bitflips(stream, driver, key1_reversed, key0_reversed, timeout);
   if (result == 1) {
     return;
+  }
   chprintf(stream, "\t\tfailed\n");
   // bruteforcing one of the keys, assuming only one of them was changed
   chprintf(stream, "\ttry bruteforcing a single key...\n");
   // default unseal key0
   for (uint32_t i = 0; i <= 0xFFFF; i++) {
     ctrl = _try_unseal(driver, key0, i, timeout);
     if (ctrl.content.ss == 0x0) {
       chprintf(stream, "\t\tSUCCESS!\n");
       chprintf(stream, "\t\tkey0: 0x%X, key1: 0x%X\n", key0, i);
       return;
+    }
+  }
   chprintf(stream, "\t\tkey failed. 1/8\n");
   // reversed unseal key0
   for (uint32_t i = 0; i <= 0xFFFF; i++) {
     ctrl = _try_unseal(driver, key0_reversed, i, timeout);
     if (ctrl.content.ss == 0x0) {
       chprintf(stream, "\t\tSUCCESS!\n");
       chprintf(stream, "\t\tkey0: 0x%X, key1: 0x%X\n", key0_reversed, i);
       return;
+    }
+  }
   chprintf(stream, "\t\tkey failed. 2/8\n");
   // default unseal key0 in reversed order
   for (uint32_t i = 0; i <= 0xFFFF; i++) {
     ctrl = _try_unseal(driver, i, key0, timeout);
     if (ctrl.content.ss == 0x0) {
       chprintf(stream, "\t\tSUCCESS!\n");
       chprintf(stream, "\t\tkey0: 0x%X, key1: 0x%X\n", i, key0);
       return;
+    }
+  }
   chprintf(stream, "\t\tkey failed. 3/8\n");
   // reversed unseal key0 in reversed order
   for (uint32_t i = 0; i <= 0xFFFF; i++) {
     ctrl = _try_unseal(driver, i, key0_reversed, timeout);
     if (ctrl.content.ss == 0x0) {
       chprintf(stream, "\t\tSUCCESS!\n");
       chprintf(stream, "\t\tkey0: 0x%X, key1: 0x%X\n", i, key0_reversed);
       return;
+    }
+  }
   chprintf(stream, "\t\tkey failed. 4/8\n");
   // default unseal key1
   for (uint32_t i = 0; i <= 0xFFFF; i++) {
     ctrl = _try_unseal(driver, i, key1, timeout);
     if (ctrl.content.ss == 0x0) {
       chprintf(stream, "