You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
33 lines
1.1 KiB
33 lines
1.1 KiB
#pragma once
|
|
|
|
#include "selfdrive/sensord/sensors/i2c_sensor.h"
|
|
|
|
// Address of the chip on the bus
|
|
#define LSM6DS3_GYRO_I2C_ADDR 0x6A
|
|
|
|
// Registers of the chip
|
|
#define LSM6DS3_GYRO_I2C_REG_DRDY_CFG 0x0B
|
|
#define LSM6DS3_GYRO_I2C_REG_ID 0x0F
|
|
#define LSM6DS3_GYRO_I2C_REG_INT1_CTRL 0x0D
|
|
#define LSM6DS3_GYRO_I2C_REG_CTRL2_G 0x11
|
|
#define LSM6DS3_GYRO_I2C_REG_STAT_REG 0x1E
|
|
#define LSM6DS3_GYRO_I2C_REG_OUTX_L_G 0x22
|
|
|
|
// Constants
|
|
#define LSM6DS3_GYRO_CHIP_ID 0x69
|
|
#define LSM6DS3TRC_GYRO_CHIP_ID 0x6A
|
|
#define LSM6DS3_GYRO_ODR_104HZ (0b0100 << 4)
|
|
#define LSM6DS3_GYRO_INT1_DRDY_G 0b10
|
|
#define LSM6DS3_GYRO_DRDY_GDA 0b10
|
|
#define LSM6DS3_GYRO_DRDY_PULSE_MODE (1 << 7)
|
|
|
|
|
|
class LSM6DS3_Gyro : public I2CSensor {
|
|
uint8_t get_device_address() {return LSM6DS3_GYRO_I2C_ADDR;}
|
|
cereal::SensorEventData::SensorSource source = cereal::SensorEventData::SensorSource::LSM6DS3;
|
|
public:
|
|
LSM6DS3_Gyro(I2CBus *bus, int gpio_nr = 0, bool shared_gpio = false);
|
|
int init();
|
|
bool get_event(cereal::SensorEventData::Builder &event);
|
|
int shutdown();
|
|
};
|
|
|