|
|
@@ -47,26 +47,27 @@ uint8_t dummy_getSensorCount()
|
|
|
return 5;
|
|
|
}
|
|
|
|
|
|
-uint16_t dummy_data_acc[3] = {0x31F5, 0xCCBD, 0xAABB}; // dec: 12789, -13123, -21829
|
|
|
-uint32_t dummy_data_gyro[3] = {0x1234ABCD, 0xFEDCBA98, 0x89ABCD13}; // dec: 305441741, -19088744, -1985229549
|
|
|
-uint8_t dummy_data_mag[2] = {0xAB, 0x12}; // dec: 171, 18
|
|
|
-uint64_t dummy_data_hrate[2] = {0x1234ABCD7890ABCD, 0xABCD123498765432}; // dec: 1311862290451049421, -6067173105892699086
|
|
|
-uint16_t dummy_pressure[1] = {0x7FAB}; // dec: 32683
|
|
|
-
|
|
|
-uint8_t *dummy_data_ptrs[5] = {(uint8_t*)dummy_data_acc, (uint8_t*)dummy_data_gyro, (uint8_t*)dummy_data_mag, (uint8_t*)dummy_data_hrate, (uint8_t*)dummy_pressure};
|
|
|
-uint8_t dummy_data_lens[5] = {6, 12, 2, 16, 2};
|
|
|
+uint16_t dummy_data_acc[3] = {0x31F5, 0xCCBD, 0xAABB}; // dec: 12789, -13123, -21829
|
|
|
+uint32_t dummy_data_gyro[3] = {0x1234ABCD, 0xFEDCBA98, 0x89ABCD13}; // dec: 305441741, -19088744, -1985229549
|
|
|
+uint8_t dummy_data_mag[2] = {0xAB, 0x12}; // dec: 171, 18
|
|
|
+uint64_t dummy_data_hrate[2] = {0x1234ABCD7890ABCD,
|
|
|
+ 0xABCD123498765432}; // dec: 1311862290451049421, -6067173105892699086
|
|
|
+uint16_t dummy_pressure[1] = {0x7FAB}; // dec: 32683
|
|
|
|
|
|
+uint8_t *dummy_data_ptrs[5] = {(uint8_t *)dummy_data_acc, (uint8_t *)dummy_data_gyro, (uint8_t *)dummy_data_mag,
|
|
|
+ (uint8_t *)dummy_data_hrate, (uint8_t *)dummy_pressure};
|
|
|
+uint8_t dummy_data_lens[5] = {6, 12, 2, 16, 2};
|
|
|
|
|
|
uint8_t dummy_getData(uint8_t sensor_index, uint8_t *data)
|
|
|
{
|
|
|
uint16_t current_len = 0;
|
|
|
-
|
|
|
+
|
|
|
if (sensor_index)
|
|
|
{
|
|
|
data[current_len++] = sensor_index;
|
|
|
|
|
|
uint16_t byte_len = dummy_data_lens[sensor_index - 1];
|
|
|
-
|
|
|
+
|
|
|
for (uint16_t i = 0; i < byte_len; i++)
|
|
|
{
|
|
|
data[current_len++] = dummy_data_ptrs[sensor_index - 1][i];
|
|
|
@@ -75,7 +76,7 @@ uint8_t dummy_getData(uint8_t sensor_index, uint8_t *data)
|
|
|
else
|
|
|
{
|
|
|
uint16_t sensors = dummy_getSensorCount();
|
|
|
-
|
|
|
+
|
|
|
for (uint16_t sensor = 0; sensor < sensors; sensor++)
|
|
|
{
|
|
|
data[current_len++] = sensor + 1;
|