github/SlimeVR-Tracker-ESP
1
1
Fork 0
mirror of https://github.com/SlimeVR/SlimeVR-Tracker-ESP.git synced 2026-04-06 02:01:57 +02:00
Code Issues 76 Packages Projects Releases Wiki Activity

Fix tests

Browse Source
This commit is contained in:
Eiren Rain
2022-12-25 21:21:38 +01:00
parent 92ded06b5b
commit cb188cfd7a
3 changed files with 8 additions and 6 deletions
Download Patch File Download Diff File Expand all files Collapse all files

10
lib/bno080/BNO080.cpp
View File

@@ -72,13 +72,13 @@ boolean BNO080::begin(uint8_t deviceAddress, TwoWire &wirePort, uint8_t intPin)
{
if (shtpData[0] == SHTP_REPORT_PRODUCT_ID_RESPONSE)
{
swMajor = shtpData[2];
swMinor = shtpData[3];
swPartNumber = ((uint32_t)shtpData[7] << 24) | ((uint32_t)shtpData[6] << 16) | ((uint32_t)shtpData[5] << 8) | ((uint32_t)shtpData[4]);
swBuildNumber = ((uint32_t)shtpData[11] << 24) | ((uint32_t)shtpData[10] << 16) | ((uint32_t)shtpData[9] << 8) | ((uint32_t)shtpData[8]);
swVersionPatch = ((uint16_t)shtpData[13] << 8) | ((uint16_t)shtpData[12]);
if (_printDebug == true)
{
swMajor = shtpData[2];
swMinor = shtpData[3];
swPartNumber = ((uint32_t)shtpData[7] << 24) | ((uint32_t)shtpData[6] << 16) | ((uint32_t)shtpData[5] << 8) | ((uint32_t)shtpData[4]);
swBuildNumber = ((uint32_t)shtpData[11] << 24) | ((uint32_t)shtpData[10] << 16) | ((uint32_t)shtpData[9] << 8) | ((uint32_t)shtpData[8]);
swVersionPatch = ((uint16_t)shtpData[13] << 8) | ((uint16_t)shtpData[12]);
_debugPort->print(F("SW Version Major: 0x"));
_debugPort->print(swMajor, HEX);
_debugPort->print(F(" SW Version Minor: 0x"));

1
src/sensors/bno080sensor.cpp
View File

@@ -91,6 +91,7 @@ void BNO080Sensor::motionLoop()
//Look for reports from the IMU
while (imu.dataAvailable())
{
hadData = true;
#if ENABLE_INSPECTION
{
int16_t rX = imu.getRawGyroX();

3
src/serial/serialcommands.cpp
View File

@@ -121,7 +121,7 @@ namespace SerialCommands {
if (parser->equalCmdParam(1, "TEST")) {
logger.info(
"[TEST]Board: %d, hardware: %d, build: %d, firmware: %s, mac: %s",
"[TEST] Board: %d, hardware: %d, build: %d, firmware: %s, mac: %s",
BOARD,
HARDWARE_MCU,
FIRMWARE_BUILD_NUMBER,
@@ -129,6 +129,7 @@ namespace SerialCommands {
WiFi.macAddress()
);
Sensor* sensor1 = sensorManager.getFirst();
sensor1->motionLoop();
logger.info(
"[TEST] Sensor 1: %s",
getIMUNameByType(sensor1->getSensorType())