BMI088: accel get max rate from PX4Accelerometer

This commit is contained in:
Daniel Agar
2020-06-15 10:19:14 -04:00
parent e819f99064
commit 6c78c62d9d
2 changed files with 3 additions and 9 deletions
@@ -43,14 +43,13 @@ namespace Bosch::BMI088::Accelerometer
BMI088_Accelerometer::BMI088_Accelerometer(I2CSPIBusOption bus_option, int bus, uint32_t device, enum Rotation rotation,
int bus_frequency, spi_mode_e spi_mode, spi_drdy_gpio_t drdy_gpio) :
BMI088(DRV_ACC_DEVTYPE_BMI088, "BMI088_Accelerometer", bus_option, bus, device, spi_mode, bus_frequency, drdy_gpio),
ModuleParams(nullptr),
_px4_accel(get_device_id(), ORB_PRIO_HIGH, rotation)
{
if (drdy_gpio != 0) {
_drdy_interval_perf = perf_alloc(PC_INTERVAL, MODULE_NAME"_accel: DRDY interval");
}
ConfigureSampleRate(_param_imu_gyro_rate_max.get());
ConfigureSampleRate(_px4_accel.get_max_rate_hz());
}
BMI088_Accelerometer::~BMI088_Accelerometer()
@@ -286,7 +285,7 @@ void BMI088_Accelerometer::ConfigureAccel()
void BMI088_Accelerometer::ConfigureSampleRate(int sample_rate)
{
if (sample_rate == 0 || sample_rate > 800) {
if (sample_rate == 0) {
sample_rate = 800; // default to 800 Hz
}
@@ -36,14 +36,13 @@
#include "BMI088.hpp"
#include <lib/drivers/accelerometer/PX4Accelerometer.hpp>
#include <px4_platform_common/module_params.h>
#include "Bosch_BMI088_Accelerometer_Registers.hpp"
namespace Bosch::BMI088::Accelerometer
{
class BMI088_Accelerometer : public BMI088, public ModuleParams
class BMI088_Accelerometer : public BMI088
{
public:
BMI088_Accelerometer(I2CSPIBusOption bus_option, int bus, uint32_t device, enum Rotation rotation, int bus_frequency,
@@ -130,10 +129,6 @@ private:
{ Register::INT1_IO_CONF, INT1_IO_CONF_BIT::int1_out, 0 },
{ Register::INT1_INT2_MAP_DATA, INT1_INT2_MAP_DATA_BIT::int1_fwm, 0},
};
DEFINE_PARAMETERS(
(ParamInt<px4::params::IMU_GYRO_RATEMAX>) _param_imu_gyro_rate_max
)
};
} // namespace Bosch::BMI088::Accelerometer