27#include "generated/modules.h"
35#if IMU_CUBE_ORANGEPLUS_LTS
39#if IMU_CUBE_ORANGEPLUS_LTS
45#if IMU_CUBE_ORANGEPLUS
58#if IMU_CUBE_ORANGEPLUS_LTS
61 imu1.spi.p = &CUBE_IMU1_SPI_DEV;
62 imu1.spi.slave_idx = CUBE_IMU1_SPI_SLAVE_IDX;
76 imu2.spi.p = &CUBE_IMU2_SPI_DEV;
77 imu2.spi.slave_idx = CUBE_IMU2_SPI_SLAVE_IDX;
90 imu3.spi.p = &CUBE_IMU3_SPI_DEV;
91 imu3.spi.slave_idx = CUBE_IMU3_SPI_SLAVE_IDX;
105 imu1.spi.p = &CUBE_IMU1_SPI_DEV;
106 imu1.spi.slave_idx = CUBE_IMU1_SPI_SLAVE_IDX;
121#if IMU_CUBE_ORANGEPLUS
126 imu2.spi.p = &CUBE_IMU2_SPI_DEV;
127 imu2.spi.slave_idx = CUBE_IMU2_SPI_SLAVE_IDX;
134 imu2.accel_aaf = 213;
149 imu2.config.smplrt_div = 3;
167 imu3.spi.p = &CUBE_IMU3_SPI_DEV;
168 imu3.spi.slave_idx = CUBE_IMU3_SPI_SLAVE_IDX;
187#if IMU_CUBE_ORANGEPLUS_LTS
193#if IMU_CUBE_ORANGEPLUS
204#if IMU_CUBE_ORANGEPLUS_LTS
211#if IMU_CUBE_ORANGEPLUS
215 if (
imu2.data_available) {
230 imu2.data_available =
false;
233 AbiSendMsgIMU_GYRO_RAW(
IMU_CUBE2_ID, now_ts, &rates, 1, IMU_CUBE_PERIODIC_FREQ,
imu2.temp);
234 AbiSendMsgIMU_ACCEL_RAW(
IMU_CUBE2_ID, now_ts, &accel, 1, IMU_CUBE_PERIODIC_FREQ,
imu2.temp);
Main include for ABI (AirBorneInterface).
uint32_t get_sys_time_usec(void)
Get the time in microseconds since startup.
int32_t phi
in rad with INT32_ANGLE_FRAC
int32_t psi
in rad with INT32_ANGLE_FRAC
int32_t theta
in rad with INT32_ANGLE_FRAC
#define ANGLE_BFP_OF_REAL(_af)
#define int32_rmat_of_eulers
Rotation matrix from Euler angles.
void imu_set_defaults_gyro(uint8_t abi_id, const struct Int32RMat *imu_to_sensor, const struct Int32Rates *neutral, const struct FloatRates *scale_f)
Set the defaults for a gyro sensor WARNING: Should be called before sensor is publishing messages to ...
void imu_set_defaults_accel(uint8_t abi_id, const struct Int32RMat *imu_to_sensor, const struct Int32Vect3 *neutral, const struct FloatVect3 *scale_f)
Set the defaults for a accel sensor WARNING: Should be called before sensor is publishing messages to...
Inertial Measurement Unit interface.
static struct Mpu60x0_Spi imu2
void imu_cube_periodic(void)
static struct invensense2_t imu3
static struct invensense2_t imu1
void imu_cube_event(void)
void invensense2_event(struct invensense2_t *inv)
Should be called in the event thread.
void invensense2_periodic(struct invensense2_t *inv)
Should be called periodically to request sensor readings.
void invensense2_init(struct invensense2_t *inv)
Initialize the invensense v2 sensor instance.
Driver for the Invensense V2 IMUs ICM20948, ICM20648 and ICM20649.
@ INVENSENSE2_GYRO_DLPF_229HZ
@ INVENSENSE2_GYRO_RANGE_4000DPS
Only possible for ICM20649.
@ INVENSENSE2_ACCEL_RANGE_30G
Only possible for ICM20649.
@ INVENSENSE2_ACCEL_DLPF_265HZ
void invensense3_periodic(struct invensense3_t *inv)
Should be called periodically to request sensor readings.
void invensense3_event(struct invensense3_t *inv)
Should be called in the event thread.
void invensense3_init(struct invensense3_t *inv)
Initialize the invensense v3 sensor instance.
Driver for the Invensense V3 IMUs ICM40605, ICM40609, ICM42605, IIM42652 and ICM42688.
@ INVENSENSE3_ACCEL_RANGE_32G
Only possible for ICM40609.
@ INVENSENSE3_GYRO_ODR_4KHZ
@ INVENSENSE3_PARSER_FIFO
@ INVENSENSE3_ACCEL_ODR_4KHZ
@ INVENSENSE3_GYRO_RANGE_2000DPS
void invensense3_456_init(struct invensense3_456_t *inv)
Initialize the invensense v3 sensor instance.
void invensense3_456_event(struct invensense3_456_t *inv)
Should be called in the event thread.
void invensense3_456_periodic(struct invensense3_456_t *inv)
Should be called periodically to request sensor readings.
Driver for the Invensense 456XY IMUs:
@ INVENSENSE3_456_ODR_6_4KHZ
const struct FloatVect3 MPU60X0_ACCEL_SENS_F[4]
const struct FloatRates MPU60X0_GYRO_SENS_F[4]
@ MPU60X0_GYRO_RANGE_2000
@ MPU60X0_ACCEL_RANGE_16G
void mpu60x0_spi_event(struct Mpu60x0_Spi *mpu)
void mpu60x0_spi_init(struct Mpu60x0_Spi *mpu, struct spi_periph *spi_p, uint8_t slave_idx)
Driver for the MPU-60X0 using SPI.
static void mpu60x0_spi_periodic(struct Mpu60x0_Spi *mpu)
convenience function: read or start configuration if not already initialized
Architecture independent SPI (Serial Peripheral Interface) API.
int int32_t
Typedef defining 32 bit int type.
unsigned int uint32_t
Typedef defining 32 bit unsigned int type.