update: added support for IMU and Lottie JSON
This commit is contained in:
166
components/SensorLib/src/bosch/common/bosch_interfaces.cpp
Normal file
166
components/SensorLib/src/bosch/common/bosch_interfaces.cpp
Normal 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 */
|
||||
61
components/SensorLib/src/bosch/common/bosch_interfaces.h
Normal file
61
components/SensorLib/src/bosch/common/bosch_interfaces.h
Normal 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
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
987
components/SensorLib/src/bosch/common/common.cpp
Normal file
987
components/SensorLib/src/bosch/common/common.cpp
Normal 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);
|
||||
}
|
||||
}
|
||||
|
||||
65
components/SensorLib/src/bosch/common/common.h
Normal file
65
components/SensorLib/src/bosch/common/common.h
Normal 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_ */
|
||||
Reference in New Issue
Block a user