Cansat
/
esp32_BNO08x
2
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

use default_sensor_cfg arg

This commit is contained in:
myles-parfeniuk 2024-11-19 21:40:52 -08:00
parent 54ceea449f
commit 4ef38a040d
1 changed files with 5 additions and 20 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

25
source/BNO08x.cpp
View File

@ -850,7 +850,6 @@ bool BNO08x::enable_gravity(uint32_t time_between_reports, sh2_SensorConfig_t se
}
else
{
ESP_LOGE(TAG, "ENABLED");
user_report_periods.gravity = time_between_reports;
xEventGroupSetBits(evt_grp_report_en, EVT_GRP_RPT_GRAVITY_BIT_EN);
return true;
@ -952,31 +951,17 @@ esp_err_t BNO08x::wait_for_hint()
*/
esp_err_t BNO08x::enable_report(sh2_SensorId_t sensor_ID, uint32_t time_between_reports, sh2_SensorConfig_t sensor_cfg)
{
static sh2_SensorConfig_t config;
int sh2_res = SH2_ERR;
xSemaphoreTake(sh2_HAL_lock, portMAX_DELAY);
// These sensor options are disabled or not used in most cases
config.changeSensitivityEnabled = false;
config.wakeupEnabled = false;
config.changeSensitivityRelative = false;
config.alwaysOnEnabled = false;
config.changeSensitivity = 0;
config.batchInterval_us = 0;
config.sensorSpecific = 0;
sensor_cfg.reportInterval_us = time_between_reports;
sh2_res = sh2_setSensorConfig(sensor_ID, &sensor_cfg);
xSemaphoreGive(sh2_HAL_lock);
config.reportInterval_us = time_between_reports;
if (sh2_setSensorConfig(sensor_ID, &config) != SH2_OK)
{
xSemaphoreGive(sh2_HAL_lock);
if (sh2_res != SH2_OK)
return ESP_FAIL;
}
else
{
xSemaphoreGive(sh2_HAL_lock);
return ESP_OK;
}
}
esp_err_t BNO08x::re_enable_reports()