update: added support for IMU and Lottie JSON

This commit is contained in:
2026-01-24 13:50:49 +05:30
parent ecf234efa5
commit 2c731c72e3
868 changed files with 318873 additions and 894 deletions

View File

@@ -0,0 +1,166 @@
/**
*
* @license MIT License
*
* Copyright (c) 2022 lewis he
*
* Permission is hereby granted, free of charge, to any person obtaining a copy
* of this software and associated documentation files (the "Software"), to deal
* in the Software without restriction, including without limitation the rights
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
* copies of the Software, and to permit persons to whom the Software is
* furnished to do so, subject to the following conditions:
*
* The above copyright notice and this permission notice shall be included in all
* copies or substantial portions of the Software.
*
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
* SOFTWARE.
*
* @file bosch_interfaces.cpp
* @author Lewis He (lewishe@outlook.com)
* @date 2023-10-09
*
*/
#include "bosch_interfaces.h"
#if defined(ARDUINO)
#if defined(ARDUINO_ARCH_RP2040)
SPISettings SensorInterfaces::__spiSetting = SPISettings();
#else
SPISettings SensorInterfaces::__spiSetting = SPISettings(4000000, SPI_DATA_ORDER, SPI_MODE0);
#endif
void SensorInterfaces::close_interfaces(SensorLibConfigure config)
{
}
bool SensorInterfaces::setup_interfaces(SensorLibConfigure config)
{
if (config.irq != SENSOR_PIN_NONE) {
pinMode(config.irq, INPUT_PULLDOWN);
}
switch (config.intf) {
case SENSORLIB_I2C_INTERFACE:
#if defined(ARDUINO_ARCH_RP2040)
config.u.i2c_dev.wire->end();
config.u.i2c_dev.wire->setSDA(config.u.i2c_dev.sda);
config.u.i2c_dev.wire->setSCL(config.u.i2c_dev.scl);
config.u.i2c_dev.wire->begin();
#elif defined(NRF52840_XXAA) || defined(NRF52832_XXAA)
config.u.i2c_dev.wire->end();
config.u.i2c_dev.wire->setPins(config.u.i2c_dev.sda, config.u.i2c_dev.scl);
config.u.i2c_dev.wire->begin();
#else
config.u.i2c_dev.wire->begin(config.u.i2c_dev.sda, config.u.i2c_dev.scl);
#endif
config.u.i2c_dev.wire->beginTransmission(config.u.i2c_dev.addr);
if (config.u.i2c_dev.wire->endTransmission() != 0) {
return false;
}
break;
case SENSORLIB_SPI_INTERFACE:
pinMode(config.u.spi_dev.cs, OUTPUT);
digitalWrite(config.u.spi_dev.cs, HIGH);
#if defined(ARDUINO_ARCH_RP2040)
config.u.spi_dev.spi->setSCK(config.u.spi_dev.sck);
config.u.spi_dev.spi->setRX(config.u.spi_dev.miso);
config.u.spi_dev.spi->setTX(config.u.spi_dev.mosi);
config.u.spi_dev.spi->begin();
#elif defined(ARDUINO_ARCH_NRF52)
config.u.spi_dev.spi->setPins(config.u.spi_dev.miso, config.u.spi_dev.sck, config.u.spi_dev.mosi);
config.u.spi_dev.spi->begin();
#elif defined(ARDUINO_ARCH_STM32)
config.u.spi_dev.spi->setSCLK(config.u.spi_dev.sck);
config.u.spi_dev.spi->setMISO(config.u.spi_dev.miso);
config.u.spi_dev.spi->setMOSI(config.u.spi_dev.mosi);
config.u.spi_dev.spi->begin();
#else
config.u.spi_dev.spi->begin(config.u.spi_dev.sck, config.u.spi_dev.miso, config.u.spi_dev.mosi);
#endif
break;
default:
break;
}
return true;
}
int8_t SensorInterfaces::bhy2_spi_read(uint8_t reg_addr, uint8_t *reg_data, uint32_t length, void *intf_ptr)
{
SensorLibConfigure *pConfig = (SensorLibConfigure *)intf_ptr;
if (!pConfig) {
return DEV_WIRE_ERR;
}
digitalWrite(pConfig->u.spi_dev.cs, LOW);
pConfig->u.spi_dev.spi->beginTransaction(__spiSetting);
pConfig->u.spi_dev.spi->transfer((reg_addr));
for (size_t i = 0; i < length; i++) {
reg_data[i] = pConfig->u.spi_dev.spi->transfer(0x00);
}
pConfig->u.spi_dev.spi->endTransaction();
digitalWrite(pConfig->u.spi_dev.cs, HIGH);
return DEV_WIRE_NONE;
}
int8_t SensorInterfaces::bhy2_spi_write(uint8_t reg_addr, const uint8_t *reg_data, uint32_t length, void *intf_ptr)
{
SensorLibConfigure *pConfig = (SensorLibConfigure *)intf_ptr;
if (!pConfig) {
return DEV_WIRE_ERR;
}
digitalWrite(pConfig->u.spi_dev.cs, LOW);
pConfig->u.spi_dev.spi->beginTransaction(__spiSetting);
pConfig->u.spi_dev.spi->transfer(reg_addr);
pConfig->u.spi_dev.spi->transfer((uint8_t *)reg_data, length);
pConfig->u.spi_dev.spi->endTransaction();
digitalWrite(pConfig->u.spi_dev.cs, HIGH);
return DEV_WIRE_NONE;
}
int8_t SensorInterfaces::bhy2_i2c_read(uint8_t reg_addr, uint8_t *reg_data, uint32_t length, void *intf_ptr)
{
SensorLibConfigure *pConfig = (SensorLibConfigure *)intf_ptr;
if (!pConfig) {
return DEV_WIRE_ERR;
}
pConfig->u.i2c_dev.wire->beginTransmission(pConfig->u.i2c_dev.addr);
pConfig->u.i2c_dev.wire->write(reg_addr);
if (pConfig->u.i2c_dev.wire->endTransmission() != 0) {
return DEV_WIRE_ERR;
}
pConfig->u.i2c_dev.wire->requestFrom(pConfig->u.i2c_dev.addr, length);
return pConfig->u.i2c_dev.wire->readBytes(reg_data, length) == length ? DEV_WIRE_NONE : DEV_WIRE_ERR;
}
int8_t SensorInterfaces::bhy2_i2c_write(uint8_t reg_addr, const uint8_t *reg_data, uint32_t length, void *intf_ptr)
{
SensorLibConfigure *pConfig = (SensorLibConfigure *)intf_ptr;
if (!pConfig) {
return DEV_WIRE_ERR;
}
pConfig->u.i2c_dev.wire->beginTransmission(pConfig->u.i2c_dev.addr);
pConfig->u.i2c_dev.wire->write(reg_addr);
pConfig->u.i2c_dev.wire->write(reg_data, length);
return (pConfig->u.i2c_dev.wire->endTransmission() == 0) ? 0 : DEV_WIRE_ERR;
}
void SensorInterfaces::bhy2_delay_us(uint32_t us, void *private_data)
{
(void)private_data;
delayMicroseconds(us);
}
#endif /*Arduino */

View File

@@ -0,0 +1,61 @@
/**
*
* @license MIT License
*
* Copyright (c) 2022 lewis he
*
* Permission is hereby granted, free of charge, to any person obtaining a copy
* of this software and associated documentation files (the "Software"), to deal
* in the Software without restriction, including without limitation the rights
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
* copies of the Software, and to permit persons to whom the Software is
* furnished to do so, subject to the following conditions:
*
* The above copyright notice and this permission notice shall be included in all
* copies or substantial portions of the Software.
*
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
* SOFTWARE.
*
* @file bosch_interfaces.h
* @author Lewis He (lewishe@outlook.com)
* @date 2023-10-09
*
*/
#pragma once
#include "SensorLib.h"
#if defined(ARDUINO)
class SensorInterfaces
{
public:
static bool setup_interfaces(SensorLibConfigure config);
static void close_interfaces(SensorLibConfigure config);
static int8_t bhy2_spi_read(uint8_t reg_addr, uint8_t *reg_data, uint32_t length, void *intf_ptr);
static int8_t bhy2_spi_write(uint8_t reg_addr, const uint8_t *reg_data, uint32_t length, void *intf_ptr);
static int8_t bhy2_i2c_read(uint8_t reg_addr, uint8_t *reg_data, uint32_t length, void *intf_ptr);
static int8_t bhy2_i2c_write(uint8_t reg_addr, const uint8_t *reg_data, uint32_t length, void *intf_ptr);
static void bhy2_delay_us(uint32_t us, void *private_data);
private:
static SPISettings __spiSetting;
};
#endif

View File

@@ -0,0 +1,987 @@
/**
* Copyright (c) 2023 Bosch Sensortec GmbH. All rights reserved.
*
* BSD-3-Clause
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions are met:
*
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
*
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
*
* 3. Neither the name of the copyright holder nor the names of its
* contributors may be used to endorse or promote products derived from
* this software without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
* COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
* (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
* SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
* STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
* IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
* POSSIBILITY OF SUCH DAMAGE.
*
* @file common.c
* @brief Common source file for the BHy260 examples
* @note Adapting Arduino based on BHY2-Sensor-API by lewis
*/
#include "common.h"
#include "bosch/bhy2_parse.h"
#include "bosch/bhy2.h"
void time_to_s_ns(uint64_t time_ticks, uint32_t *s, uint32_t *ns, uint64_t *tns)
{
*tns = time_ticks * 15625; /* timestamp is now in nanoseconds */
*s = (uint32_t)(*tns / UINT64_C(1000000000));
*ns = (uint32_t)(*tns - ((*s) * UINT64_C(1000000000)));
}
const char *get_api_error(int8_t error_code)
{
const char *ret;
switch (error_code) {
case BHY2_OK:
ret = "[API Success]";
break;
case BHY2_E_NULL_PTR:
ret = "[API Error] Null pointer";
break;
case BHY2_E_INVALID_PARAM:
ret = "[API Error] Invalid parameter";
break;
case BHY2_E_IO:
ret = "[API Error] IO error";
break;
case BHY2_E_MAGIC:
ret = "[API Error] Invalid firmware";
break;
case BHY2_E_TIMEOUT:
ret = "[API Error] Timed out";
break;
case BHY2_E_BUFFER:
ret = "[API Error] Invalid buffer";
break;
case BHY2_E_INVALID_FIFO_TYPE:
ret = "[API Error] Invalid FIFO type";
break;
case BHY2_E_INVALID_EVENT_SIZE:
ret = "[API Error] Invalid Event size";
break;
case BHY2_E_PARAM_NOT_SET:
ret = "[API Error] Parameter not set";
break;
default:
ret = "[API Error] Unknown API error code";
}
return ret;
}
const char *get_sensor_error_text(uint8_t sensor_error)
{
const char *ret;
switch (sensor_error) {
case 0x00:
break;
case 0x10:
ret = "[Sensor error] Bootloader reports: Firmware Expected Version Mismatch";
break;
case 0x11:
ret = "[Sensor error] Bootloader reports: Firmware Upload Failed: Bad Header CRC";
break;
case 0x12:
ret = "[Sensor error] Bootloader reports: Firmware Upload Failed: SHA Hash Mismatch";
break;
case 0x13:
ret = "[Sensor error] Bootloader reports: Firmware Upload Failed: Bad Image CRC";
break;
case 0x14:
ret = "[Sensor error] Bootloader reports: Firmware Upload Failed: ECDSA Signature Verification Failed";
break;
case 0x15:
ret = "[Sensor error] Bootloader reports: Firmware Upload Failed: Bad Public Key CRC";
break;
case 0x16:
ret = "[Sensor error] Bootloader reports: Firmware Upload Failed: Signed Firmware Required";
break;
case 0x17:
ret = "[Sensor error] Bootloader reports: Firmware Upload Failed: FW Header Missing";
break;
case 0x19:
ret = "[Sensor error] Bootloader reports: Unexpected Watchdog Reset";
break;
case 0x1A:
ret = "[Sensor error] ROM Version Mismatch";
break;
case 0x1B:
ret = "[Sensor error] Bootloader reports: Fatal Firmware Error";
break;
case 0x1C:
ret = "[Sensor error] Chained Firmware Error: Next Payload Not Found";
break;
case 0x1D:
ret = "[Sensor error] Chained Firmware Error: Payload Not Valid";
break;
case 0x1E:
ret = "[Sensor error] Chained Firmware Error: Payload Entries Invalid";
break;
case 0x1F:
ret = "[Sensor error] Bootloader reports: Bootloader Error: OTP CRC Invalid";
break;
case 0x20:
ret = "[Sensor error] Firmware Init Failed";
break;
case 0x21:
ret = "[Sensor error] Sensor Init Failed: Unexpected Device ID";
break;
case 0x22:
ret = "[Sensor error] Sensor Init Failed: No Response from Device";
break;
case 0x23:
ret = "[Sensor error] Sensor Init Failed: Unknown";
break;
case 0x24:
ret = "[Sensor error] Sensor Error: No Valid Data";
break;
case 0x25:
ret = "[Sensor error] Slow Sample Rate";
break;
case 0x26:
ret = "[Sensor error] Data Overflow (saturated sensor data)";
break;
case 0x27:
ret = "[Sensor error] Stack Overflow";
break;
case 0x28:
ret = "[Sensor error] Insufficient Free RAM";
break;
case 0x29:
ret = "[Sensor error] Sensor Init Failed: Driver Parsing Error";
break;
case 0x2A:
ret = "[Sensor error] Too Many RAM Banks Required";
break;
case 0x2B:
ret = "[Sensor error] Invalid Event Specified";
break;
case 0x2C:
ret = "[Sensor error] More than 32 On Change";
break;
case 0x2D:
ret = "[Sensor error] Firmware Too Large";
break;
case 0x2F:
ret = "[Sensor error] Invalid RAM Banks";
break;
case 0x30:
ret = "[Sensor error] Math Error";
break;
case 0x40:
ret = "[Sensor error] Memory Error";
break;
case 0x41:
ret = "[Sensor error] SWI3 Error";
break;
case 0x42:
ret = "[Sensor error] SWI4 Error";
break;
case 0x43:
ret = "[Sensor error] Illegal Instruction Error";
break;
case 0x44:
ret = "[Sensor error] Bootloader reports: Unhandled Interrupt Error / Exception / Postmortem Available";
break;
case 0x45:
ret = "[Sensor error] Invalid Memory Access";
break;
case 0x50:
ret = "[Sensor error] Algorithm Error: BSX Init";
break;
case 0x51:
ret = "[Sensor error] Algorithm Error: BSX Do Step";
break;
case 0x52:
ret = "[Sensor error] Algorithm Error: Update Sub";
break;
case 0x53:
ret = "[Sensor error] Algorithm Error: Get Sub";
break;
case 0x54:
ret = "[Sensor error] Algorithm Error: Get Phys";
break;
case 0x55:
ret = "[Sensor error] Algorithm Error: Unsupported Phys Rate";
break;
case 0x56:
ret = "[Sensor error] Algorithm Error: Cannot find BSX Driver";
break;
case 0x60:
ret = "[Sensor error] Sensor Self-Test Failure";
break;
case 0x61:
ret = "[Sensor error] Sensor Self-Test X Axis Failure";
break;
case 0x62:
ret = "[Sensor error] Sensor Self-Test Y Axis Failure";
break;
case 0x64:
ret = "[Sensor error] Sensor Self-Test Z Axis Failure";
break;
case 0x65:
ret = "[Sensor error] FOC Failure";
break;
case 0x66:
ret = "[Sensor error] Sensor Busy";
break;
case 0x6F:
ret = "[Sensor error] Self-Test or FOC Test Unsupported";
break;
case 0x72:
ret = "[Sensor error] No Host Interrupt Set";
break;
case 0x73:
ret = "[Sensor error] Event ID Passed to Host Interface Has No Known Size";
break;
case 0x75:
ret = "[Sensor error] Host Download Channel Underflow (Host Read Too Fast)";
break;
case 0x76:
ret = "[Sensor error] Host Upload Channel Overflow (Host Wrote Too Fast)";
break;
case 0x77:
ret = "[Sensor error] Host Download Channel Empty";
break;
case 0x78:
ret = "[Sensor error] DMA Error";
break;
case 0x79:
ret = "[Sensor error] Corrupted Input Block Chain";
break;
case 0x7A:
ret = "[Sensor error] Corrupted Output Block Chain";
break;
case 0x7B:
ret = "[Sensor error] Buffer Block Manager Error";
break;
case 0x7C:
ret = "[Sensor error] Input Channel Not Word Aligned";
break;
case 0x7D:
ret = "[Sensor error] Too Many Flush Events";
break;
case 0x7E:
ret = "[Sensor error] Unknown Host Channel Error";
break;
case 0x81:
ret = "[Sensor error] Decimation Too Large";
break;
case 0x90:
ret = "[Sensor error] Master SPI/I2C Queue Overflow";
break;
case 0x91:
ret = "[Sensor error] SPI/I2C Callback Error";
break;
case 0xA0:
ret = "[Sensor error] Timer Scheduling Error";
break;
case 0xB0:
ret = "[Sensor error] Invalid GPIO for Host IRQ";
break;
case 0xB1:
ret = "[Sensor error] Error Sending Initialized Meta Events";
break;
case 0xC0:
ret = "[Sensor error] Bootloader reports: Command Error";
break;
case 0xC1:
ret = "[Sensor error] Bootloader reports: Command Too Long";
break;
case 0xC2:
ret = "[Sensor error] Bootloader reports: Command Buffer Overflow";
break;
case 0xD0:
ret = "[Sensor error] User Mode Error: Sys Call Invalid";
break;
case 0xD1:
ret = "[Sensor error] User Mode Error: Trap Invalid";
break;
case 0xE1:
ret = "[Sensor error] Firmware Upload Failed: Firmware header corrupt";
break;
case 0xE2:
ret = "[Sensor error] Sensor Data Injection: Invalid input stream";
break;
default:
ret = "[Sensor error] Unknown error code";
}
return ret;
}
const char *get_sensor_name(uint8_t sensor_id)
{
const char *ret;
switch (sensor_id) {
case BHY2_SENSOR_ID_ACC_PASS:
ret = "Accelerometer passthrough";
break;
case BHY2_SENSOR_ID_ACC_RAW:
ret = "Accelerometer uncalibrated";
break;
case BHY2_SENSOR_ID_ACC:
ret = "Accelerometer corrected";
break;
case BHY2_SENSOR_ID_ACC_BIAS:
ret = "Accelerometer offset";
break;
case BHY2_SENSOR_ID_ACC_WU:
ret = "Accelerometer corrected wake up";
break;
case BHY2_SENSOR_ID_ACC_RAW_WU:
ret = "Accelerometer uncalibrated wake up";
break;
case BHY2_SENSOR_ID_GYRO_PASS:
ret = "Gyroscope passthrough";
break;
case BHY2_SENSOR_ID_GYRO_RAW:
ret = "Gyroscope uncalibrated";
break;
case BHY2_SENSOR_ID_GYRO:
ret = "Gyroscope corrected";
break;
case BHY2_SENSOR_ID_GYRO_BIAS:
ret = "Gyroscope offset";
break;
case BHY2_SENSOR_ID_GYRO_WU:
ret = "Gyroscope wake up";
break;
case BHY2_SENSOR_ID_GYRO_RAW_WU:
ret = "Gyroscope uncalibrated wake up";
break;
case BHY2_SENSOR_ID_MAG_PASS:
ret = "Magnetometer passthrough";
break;
case BHY2_SENSOR_ID_MAG_RAW:
ret = "Magnetometer uncalibrated";
break;
case BHY2_SENSOR_ID_MAG:
ret = "Magnetometer corrected";
break;
case BHY2_SENSOR_ID_MAG_BIAS:
ret = "Magnetometer offset";
break;
case BHY2_SENSOR_ID_MAG_WU:
ret = "Magnetometer wake up";
break;
case BHY2_SENSOR_ID_MAG_RAW_WU:
ret = "Magnetometer uncalibrated wake up";
break;
case BHY2_SENSOR_ID_GRA:
ret = "Gravity vector";
break;
case BHY2_SENSOR_ID_GRA_WU:
ret = "Gravity vector wake up";
break;
case BHY2_SENSOR_ID_LACC:
ret = "Linear acceleration";
break;
case BHY2_SENSOR_ID_LACC_WU:
ret = "Linear acceleration wake up";
break;
case BHY2_SENSOR_ID_RV:
ret = "Rotation vector";
break;
case BHY2_SENSOR_ID_RV_WU:
ret = "Rotation vector wake up";
break;
case BHY2_SENSOR_ID_GAMERV:
ret = "Game rotation vector";
break;
case BHY2_SENSOR_ID_GAMERV_WU:
ret = "Game rotation vector wake up";
break;
case BHY2_SENSOR_ID_GEORV:
ret = "Geo-magnetic rotation vector";
break;
case BHY2_SENSOR_ID_GEORV_WU:
ret = "Geo-magnetic rotation vector wake up";
break;
case BHY2_SENSOR_ID_ORI:
ret = "Orientation";
break;
case BHY2_SENSOR_ID_ORI_WU:
ret = "Orientation wake up";
break;
case BHY2_SENSOR_ID_ACC_BIAS_WU:
ret = "Accelerometer offset wake up";
break;
case BHY2_SENSOR_ID_GYRO_BIAS_WU:
ret = "Gyroscope offset wake up";
break;
case BHY2_SENSOR_ID_MAG_BIAS_WU:
ret = "Magnetometer offset wake up";
break;
case BHY2_SENSOR_ID_TEMP:
ret = "Temperature";
break;
case BHY2_SENSOR_ID_BARO:
ret = "Barometer";
break;
case BHY2_SENSOR_ID_HUM:
ret = "Humidity";
break;
case BHY2_SENSOR_ID_GAS:
ret = "Gas";
break;
case BHY2_SENSOR_ID_TEMP_WU:
ret = "Temperature wake up";
break;
case BHY2_SENSOR_ID_BARO_WU:
ret = "Barometer wake up";
break;
case BHY2_SENSOR_ID_HUM_WU:
ret = "Humidity wake up";
break;
case BHY2_SENSOR_ID_GAS_WU:
ret = "Gas wake up";
break;
case BHY2_SENSOR_ID_KLIO:
ret = "Klio";
break;
case BHY2_SENSOR_ID_KLIO_LOG:
ret = "Klio log";
break;
case BHY2_SENSOR_ID_SWIM:
ret = "Swim recognition";
break;
case BHY2_SENSOR_ID_SI_ACCEL:
ret = "SI Accel";
break;
case BHY2_SENSOR_ID_SI_GYROS:
ret = "SI Gyro";
break;
case BHY2_SENSOR_ID_LIGHT:
ret = "Light";
break;
case BHY2_SENSOR_ID_LIGHT_WU:
ret = "Light wake up";
break;
case BHY2_SENSOR_ID_PROX:
ret = "Proximity";
break;
case BHY2_SENSOR_ID_PROX_WU:
ret = "Proximity wake up";
break;
case BHY2_SENSOR_ID_STC:
ret = "Step counter";
break;
case BHY2_SENSOR_ID_STC_WU:
ret = "Step counter wake up";
break;
case BHY2_SENSOR_ID_STC_LP:
ret = "Low Power Step counter";
break;
case BHY2_SENSOR_ID_STC_LP_WU:
ret = "Low Power Step counter wake up";
break;
case BHY2_SENSOR_ID_SIG:
ret = "Significant motion";
break;
case BHY2_SENSOR_ID_STD:
ret = "Step detector";
break;
case BHY2_SENSOR_ID_STD_WU:
ret = "Step detector wake up";
break;
case BHY2_SENSOR_ID_TILT_DETECTOR:
ret = "Tilt detector";
break;
case BHY2_SENSOR_ID_WAKE_GESTURE:
ret = "Wake gesture";
break;
case BHY2_SENSOR_ID_GLANCE_GESTURE:
ret = "Glance gesture";
break;
case BHY2_SENSOR_ID_PICKUP_GESTURE:
ret = "Pickup gesture";
break;
case BHY2_SENSOR_ID_SIG_LP:
ret = "Low Power Significant motion";
break;
case BHY2_SENSOR_ID_SIG_LP_WU:
ret = "Low Power Significant motion wake up";
break;
case BHY2_SENSOR_ID_STD_LP:
ret = "Low Power Step detector";
break;
case BHY2_SENSOR_ID_STD_LP_WU:
ret = "Low Power Step detector wake up";
break;
case BHY2_SENSOR_ID_AR:
ret = "Activity recognition";
break;
case BHY2_SENSOR_ID_EXCAMERA:
ret = "External camera trigger";
break;
case BHY2_SENSOR_ID_GPS:
ret = "GPS";
break;
case BHY2_SENSOR_ID_WRIST_TILT_GESTURE:
ret = "Wrist tilt gesture";
break;
case BHY2_SENSOR_ID_DEVICE_ORI:
ret = "Device orientation";
break;
case BHY2_SENSOR_ID_DEVICE_ORI_WU:
ret = "Device orientation wake up";
break;
case BHY2_SENSOR_ID_STATIONARY_DET:
ret = "Stationary detect";
break;
case BHY2_SENSOR_ID_ANY_MOTION_LP:
ret = "Low Power Any motion";
break;
case BHY2_SENSOR_ID_ANY_MOTION_LP_WU:
ret = "Low Power Any motion wake up";
break;
case BHI3_SENSOR_ID_NO_MOTION_LP_WU:
ret = "Low Power No Motion wake up";
break;
case BHY2_SENSOR_ID_MOTION_DET:
ret = "Motion detect";
break;
case BHI3_SENSOR_ID_AR_WEAR_WU:
ret = "Activity recognition for Wearables";
break;
case BHI3_SENSOR_ID_WRIST_WEAR_LP_WU:
ret = "Low Power Wrist Wear wake up";
break;
case BHI3_SENSOR_ID_WRIST_GEST_DETECT_LP_WU:
ret = "Low Power Wrist Gesture wake up";
break;
case BHI3_SENSOR_ID_MULTI_TAP:
ret = "Multi Tap Detector";
break;
case BHY2_SENSOR_ID_AIR_QUALITY:
ret = "Air Quality";
break;
case BHY2_SENSOR_ID_HEAD_ORI_MIS_ALG:
ret = "Head Misalignment Calibrator";
break;
case BHY2_SENSOR_ID_IMU_HEAD_ORI_Q:
ret = "IMU Head Orientation Quaternion";
break;
case BHY2_SENSOR_ID_NDOF_HEAD_ORI_Q:
ret = "NDOF Head Orientation Quaternion";
break;
case BHY2_SENSOR_ID_IMU_HEAD_ORI_E:
ret = "IMU Head Orientation Euler";
break;
case BHY2_SENSOR_ID_NDOF_HEAD_ORI_E:
ret = "NDOF Head Orientation Euler";
break;
default:
if ((sensor_id >= BHY2_SENSOR_ID_CUSTOM_START) && (sensor_id <= BHY2_SENSOR_ID_CUSTOM_END)) {
ret = "Custom sensor ID ";
} else {
ret = "Undefined sensor ID ";
}
}
return ret;
}
float get_sensor_default_scaling(uint8_t sensor_id)
{
float scaling = -1.0f;
switch (sensor_id) {
case BHY2_SENSOR_ID_ACC_PASS:
case BHY2_SENSOR_ID_ACC_RAW:
case BHY2_SENSOR_ID_ACC:
case BHY2_SENSOR_ID_ACC_BIAS:
case BHY2_SENSOR_ID_ACC_WU:
case BHY2_SENSOR_ID_ACC_RAW_WU:
case BHY2_SENSOR_ID_GRA:
case BHY2_SENSOR_ID_GRA_WU:
case BHY2_SENSOR_ID_LACC:
case BHY2_SENSOR_ID_LACC_WU:
case BHY2_SENSOR_ID_ACC_BIAS_WU:
scaling = 1.0f / 4096.0f;
break;
case BHY2_SENSOR_ID_GYRO_PASS:
case BHY2_SENSOR_ID_GYRO_RAW:
case BHY2_SENSOR_ID_GYRO:
case BHY2_SENSOR_ID_GYRO_BIAS:
case BHY2_SENSOR_ID_GYRO_WU:
case BHY2_SENSOR_ID_GYRO_RAW_WU:
case BHY2_SENSOR_ID_GYRO_BIAS_WU:
scaling = 2000.0f / 32768.0f;
break;
case BHY2_SENSOR_ID_MAG_PASS:
case BHY2_SENSOR_ID_MAG_RAW:
case BHY2_SENSOR_ID_MAG:
case BHY2_SENSOR_ID_MAG_BIAS:
case BHY2_SENSOR_ID_MAG_WU:
case BHY2_SENSOR_ID_MAG_RAW_WU:
case BHY2_SENSOR_ID_MAG_BIAS_WU:
scaling = 2500.0f / 32768.0f;
break;
case BHY2_SENSOR_ID_RV:
case BHY2_SENSOR_ID_RV_WU:
case BHY2_SENSOR_ID_GAMERV:
case BHY2_SENSOR_ID_GAMERV_WU:
case BHY2_SENSOR_ID_GEORV:
case BHY2_SENSOR_ID_GEORV_WU:
scaling = 1.0f / 16384.0f;
break;
case BHY2_SENSOR_ID_ORI:
case BHY2_SENSOR_ID_ORI_WU:
scaling = 360.0f / 32768.0f;
break;
case BHY2_SENSOR_ID_TEMP:
case BHY2_SENSOR_ID_TEMP_WU:
scaling = 1.0f / 100.0f;
break;
case BHY2_SENSOR_ID_BARO:
case BHY2_SENSOR_ID_BARO_WU:
scaling = 100.0f / 128.0f;
break;
case BHY2_SENSOR_ID_HUM:
case BHY2_SENSOR_ID_HUM_WU:
scaling = 1.0f;
break;
case BHY2_SENSOR_ID_GAS:
case BHY2_SENSOR_ID_GAS_WU:
scaling = 1.0f;
break;
case BHY2_SENSOR_ID_LIGHT:
case BHY2_SENSOR_ID_LIGHT_WU:
scaling = 10000.0f / 216.0f;
break;
case BHY2_SENSOR_ID_PROX:
case BHY2_SENSOR_ID_PROX_WU:
scaling = 1.0f;
break;
case BHY2_SENSOR_ID_SI_ACCEL:
case BHY2_SENSOR_ID_SI_GYROS:
/* Scaling factor already applied in firmware*/
break;
case BHY2_SENSOR_ID_HEAD_ORI_MIS_ALG:
case BHY2_SENSOR_ID_IMU_HEAD_ORI_Q:
case BHY2_SENSOR_ID_NDOF_HEAD_ORI_Q:
scaling = 1.0f / 16384.0f; /*2^14 -> 16384*/
break;
case BHY2_SENSOR_ID_IMU_HEAD_ORI_E:
case BHY2_SENSOR_ID_NDOF_HEAD_ORI_E:
scaling = 360.0f / 32768.0f; /*2^15 -> 32768*/
break;
default:
scaling = -1.0f; /* Do not apply the scaling factor */
}
return scaling;
}
const char *get_sensor_parse_format(uint8_t sensor_id)
{
const char *ret;
switch (sensor_id) {
case BHY2_SENSOR_ID_ACC_PASS:
case BHY2_SENSOR_ID_ACC_RAW:
case BHY2_SENSOR_ID_ACC:
case BHY2_SENSOR_ID_ACC_BIAS:
case BHY2_SENSOR_ID_ACC_BIAS_WU:
case BHY2_SENSOR_ID_ACC_WU:
case BHY2_SENSOR_ID_ACC_RAW_WU:
case BHY2_SENSOR_ID_GYRO_PASS:
case BHY2_SENSOR_ID_GYRO_RAW:
case BHY2_SENSOR_ID_GYRO:
case BHY2_SENSOR_ID_GYRO_BIAS:
case BHY2_SENSOR_ID_GYRO_BIAS_WU:
case BHY2_SENSOR_ID_GYRO_WU:
case BHY2_SENSOR_ID_GYRO_RAW_WU:
case BHY2_SENSOR_ID_MAG_PASS:
case BHY2_SENSOR_ID_MAG_RAW:
case BHY2_SENSOR_ID_MAG:
case BHY2_SENSOR_ID_MAG_BIAS:
case BHY2_SENSOR_ID_MAG_BIAS_WU:
case BHY2_SENSOR_ID_MAG_WU:
case BHY2_SENSOR_ID_MAG_RAW_WU:
case BHY2_SENSOR_ID_GRA:
case BHY2_SENSOR_ID_GRA_WU:
case BHY2_SENSOR_ID_LACC:
case BHY2_SENSOR_ID_LACC_WU:
ret = "s16,s16,s16";
break;
case BHY2_SENSOR_ID_RV:
case BHY2_SENSOR_ID_RV_WU:
case BHY2_SENSOR_ID_GAMERV:
case BHY2_SENSOR_ID_GAMERV_WU:
case BHY2_SENSOR_ID_GEORV:
case BHY2_SENSOR_ID_GEORV_WU:
ret = "s16,s16,s16,s16,u16";
break;
case BHY2_SENSOR_ID_ORI:
case BHY2_SENSOR_ID_ORI_WU:
ret = "s16,s16,s16";
break;
case BHY2_SENSOR_ID_DEVICE_ORI:
case BHY2_SENSOR_ID_DEVICE_ORI_WU:
case BHY2_SENSOR_ID_HUM:
case BHY2_SENSOR_ID_HUM_WU:
case BHY2_SENSOR_ID_PROX:
case BHY2_SENSOR_ID_PROX_WU:
case BHY2_SENSOR_ID_EXCAMERA:
case BHI3_SENSOR_ID_MULTI_TAP:
ret = "u8";
break;
case BHY2_SENSOR_ID_TEMP:
case BHY2_SENSOR_ID_TEMP_WU:
ret = "s16";
break;
case BHY2_SENSOR_ID_BARO:
case BHY2_SENSOR_ID_BARO_WU:
ret = "u24";
break;
case BHY2_SENSOR_ID_GAS:
case BHY2_SENSOR_ID_GAS_WU:
case BHY2_SENSOR_ID_STC:
case BHY2_SENSOR_ID_STC_WU:
case BHY2_SENSOR_ID_STC_LP:
case BHY2_SENSOR_ID_STC_LP_WU:
ret = "u32";
break;
case BHY2_SENSOR_ID_KLIO:
ret = "u8,u8,u8,u8,u8,u8,f";
break;
case BHY2_SENSOR_ID_SWIM:
ret = "u16,u16,u16,u16,u16,u16,u16";
break;
case BHY2_SENSOR_ID_SI_ACCEL:
case BHY2_SENSOR_ID_SI_GYROS:
ret = "f,f,f";
break;
case BHY2_SENSOR_ID_LIGHT:
case BHY2_SENSOR_ID_LIGHT_WU:
ret = "s16";
break;
case BHY2_SENSOR_ID_SIG:
case BHY2_SENSOR_ID_STD:
case BHY2_SENSOR_ID_STD_WU:
case BHY2_SENSOR_ID_TILT_DETECTOR:
case BHY2_SENSOR_ID_WAKE_GESTURE:
case BHY2_SENSOR_ID_GLANCE_GESTURE:
case BHY2_SENSOR_ID_PICKUP_GESTURE:
case BHY2_SENSOR_ID_SIG_LP:
case BHY2_SENSOR_ID_SIG_LP_WU:
case BHY2_SENSOR_ID_STD_LP:
case BHY2_SENSOR_ID_STD_LP_WU:
case BHY2_SENSOR_ID_WRIST_TILT_GESTURE:
case BHY2_SENSOR_ID_STATIONARY_DET:
case BHY2_SENSOR_ID_ANY_MOTION_LP:
case BHY2_SENSOR_ID_ANY_MOTION_LP_WU:
case BHI3_SENSOR_ID_NO_MOTION_LP_WU:
case BHY2_SENSOR_ID_MOTION_DET:
case BHI3_SENSOR_ID_WRIST_WEAR_LP_WU:
ret = "";
break;
case BHY2_SENSOR_ID_AR:
case BHI3_SENSOR_ID_AR_WEAR_WU:
ret = "u16";
break;
case BHY2_SENSOR_ID_GPS:
ret = "st";
break;
case BHI3_SENSOR_ID_WRIST_GEST_DETECT_LP_WU:
ret = "u8";
break;
case BHY2_SENSOR_ID_AIR_QUALITY:
ret = "f32,f32,f32,f32,f32,f32,f32,u8";
break;
case BHY2_SENSOR_ID_HEAD_ORI_MIS_ALG:
case BHY2_SENSOR_ID_IMU_HEAD_ORI_Q:
case BHY2_SENSOR_ID_NDOF_HEAD_ORI_Q:
ret = "s16,s16,s16,s16,u8";
break;
case BHY2_SENSOR_ID_IMU_HEAD_ORI_E:
case BHY2_SENSOR_ID_NDOF_HEAD_ORI_E:
ret = "s16,s16,s16,u8";
break;
default:
ret = "";
}
return ret;
}
const char *get_sensor_axis_names(uint8_t sensor_id)
{
const char *ret;
switch (sensor_id) {
case BHY2_SENSOR_ID_ACC_PASS:
case BHY2_SENSOR_ID_ACC_RAW:
case BHY2_SENSOR_ID_ACC:
case BHY2_SENSOR_ID_ACC_BIAS:
case BHY2_SENSOR_ID_ACC_BIAS_WU:
case BHY2_SENSOR_ID_ACC_WU:
case BHY2_SENSOR_ID_ACC_RAW_WU:
case BHY2_SENSOR_ID_GYRO_PASS:
case BHY2_SENSOR_ID_GYRO_RAW:
case BHY2_SENSOR_ID_GYRO:
case BHY2_SENSOR_ID_GYRO_BIAS:
case BHY2_SENSOR_ID_GYRO_BIAS_WU:
case BHY2_SENSOR_ID_GYRO_WU:
case BHY2_SENSOR_ID_GYRO_RAW_WU:
case BHY2_SENSOR_ID_MAG_PASS:
case BHY2_SENSOR_ID_MAG_RAW:
case BHY2_SENSOR_ID_MAG:
case BHY2_SENSOR_ID_MAG_BIAS:
case BHY2_SENSOR_ID_MAG_BIAS_WU:
case BHY2_SENSOR_ID_MAG_WU:
case BHY2_SENSOR_ID_MAG_RAW_WU:
case BHY2_SENSOR_ID_GRA:
case BHY2_SENSOR_ID_GRA_WU:
case BHY2_SENSOR_ID_LACC:
case BHY2_SENSOR_ID_LACC_WU:
case BHY2_SENSOR_ID_SI_ACCEL:
case BHY2_SENSOR_ID_SI_GYROS:
ret = "x,y,z";
break;
case BHY2_SENSOR_ID_RV:
case BHY2_SENSOR_ID_RV_WU:
case BHY2_SENSOR_ID_GAMERV:
case BHY2_SENSOR_ID_GAMERV_WU:
case BHY2_SENSOR_ID_GEORV:
case BHY2_SENSOR_ID_GEORV_WU:
ret = "x,y,z,w,ar";
break;
case BHY2_SENSOR_ID_ORI:
case BHY2_SENSOR_ID_ORI_WU:
ret = "h,p,r";
break;
case BHY2_SENSOR_ID_DEVICE_ORI:
case BHY2_SENSOR_ID_DEVICE_ORI_WU:
ret = "o";
break;
case BHY2_SENSOR_ID_TEMP:
case BHY2_SENSOR_ID_TEMP_WU:
ret = "t";
break;
case BHY2_SENSOR_ID_BARO:
case BHY2_SENSOR_ID_BARO_WU:
ret = "p";
break;
case BHY2_SENSOR_ID_HUM:
case BHY2_SENSOR_ID_HUM_WU:
ret = "h";
break;
case BHY2_SENSOR_ID_GAS:
case BHY2_SENSOR_ID_GAS_WU:
ret = "g";
break;
case BHY2_SENSOR_ID_KLIO:
ret = "lin,lid,lpr,lcr,rin,rid,rc";
break;
case BHY2_SENSOR_ID_SWIM:
ret = "d,lc,f,br,bu,ba,sc";
break;
case BHY2_SENSOR_ID_LIGHT:
case BHY2_SENSOR_ID_LIGHT_WU:
ret = "l";
break;
case BHY2_SENSOR_ID_PROX:
case BHY2_SENSOR_ID_PROX_WU:
ret = "p";
break;
case BHY2_SENSOR_ID_STC:
case BHY2_SENSOR_ID_STC_WU:
case BHY2_SENSOR_ID_STC_LP:
case BHY2_SENSOR_ID_STC_LP_WU:
case BHY2_SENSOR_ID_EXCAMERA:
ret = "c";
break;
case BHY2_SENSOR_ID_SIG:
case BHY2_SENSOR_ID_STD:
case BHY2_SENSOR_ID_STD_WU:
case BHY2_SENSOR_ID_TILT_DETECTOR:
case BHY2_SENSOR_ID_WAKE_GESTURE:
case BHY2_SENSOR_ID_GLANCE_GESTURE:
case BHY2_SENSOR_ID_PICKUP_GESTURE:
case BHY2_SENSOR_ID_SIG_LP:
case BHY2_SENSOR_ID_SIG_LP_WU:
case BHY2_SENSOR_ID_STD_LP:
case BHY2_SENSOR_ID_STD_LP_WU:
case BHY2_SENSOR_ID_WRIST_TILT_GESTURE:
case BHY2_SENSOR_ID_STATIONARY_DET:
case BHY2_SENSOR_ID_ANY_MOTION_LP:
case BHY2_SENSOR_ID_ANY_MOTION_LP_WU:
case BHI3_SENSOR_ID_NO_MOTION_LP_WU:
case BHY2_SENSOR_ID_MOTION_DET:
case BHI3_SENSOR_ID_WRIST_WEAR_LP_WU:
ret = "e";
break;
case BHY2_SENSOR_ID_AR:
case BHI3_SENSOR_ID_AR_WEAR_WU:
ret = "a";
break;
case BHY2_SENSOR_ID_GPS:
ret = "g";
break;
case BHI3_SENSOR_ID_WRIST_GEST_DETECT_LP_WU:
ret = "wrist_gesture";
break;
case BHI3_SENSOR_ID_MULTI_TAP:
ret = "taps";
break;
case BHY2_SENSOR_ID_AIR_QUALITY:
ret = "t,h,g,i,si,c,v,a";
break;
case BHY2_SENSOR_ID_HEAD_ORI_MIS_ALG:
case BHY2_SENSOR_ID_IMU_HEAD_ORI_Q:
case BHY2_SENSOR_ID_NDOF_HEAD_ORI_Q:
ret = "x,y,z,w,a";
break;
case BHY2_SENSOR_ID_IMU_HEAD_ORI_E:
case BHY2_SENSOR_ID_NDOF_HEAD_ORI_E:
ret = "h,p,r,a";
break;
default:
ret = "";
}
return ret;
}
void check_bhy2_api(unsigned int line, const char *func, int8_t val)
{
int i = 3;
while (i--) {
Serial.printf("BHI260 API failed at line %u. The function %s returned error code %d. %s\r\n",
line,
func,
val,
get_api_error(val));
delay(1000);
}
}

View File

@@ -0,0 +1,65 @@
/**
* Copyright (c) 2023 Bosch Sensortec GmbH. All rights reserved.
*
* BSD-3-Clause
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions are met:
*
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
*
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
*
* 3. Neither the name of the copyright holder nor the names of its
* contributors may be used to endorse or promote products derived from
* this software without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
* COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
* (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
* SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
* STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
* IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
* POSSIBILITY OF SUCH DAMAGE.
*
* @file common.h
* @brief Common header file for the BHI260/BHA260 examples
* @note Adapting Arduino based on BHY2-Sensor-API by lewis
*/
#ifndef _COMMON_H_
#define _COMMON_H_
#include "bosch_interfaces.h"
#include "bosch/bhy2.h"
#include "bosch/bhi3.h"
#include "bosch/bhi3_multi_tap.h"
#include "bosch/bhy2_klio.h"
#include "bosch/bhy2_swim.h"
#include "bosch/bhy2_bsec.h"
#include "bosch/bhy2_head_tracker.h"
#define BHY2_ASSERT(x) if (x) check_bhy2_api(__LINE__, __FUNCTION__, x)
void check_bhy2_api(unsigned int line, const char *func, int8_t val);
void time_to_s_ns(uint64_t time_ticks, uint32_t *s, uint32_t *ns, uint64_t *tns);
const char *get_api_error(int8_t error_code);
const char *get_sensor_error_text(uint8_t sensor_error);
const char *get_sensor_name(uint8_t sensor_id);
float get_sensor_default_scaling(uint8_t sensor_id);
const char *get_sensor_parse_format(uint8_t sensor_id);
const char *get_sensor_axis_names(uint8_t sensor_id);
#endif /* _COMMON_H_ */