Browse Source

AP_InertialSensor: added get_loop_delta_t() API

master
Andrew Tridgell 9 years ago committed by Randy Mackay
parent
commit
93ef881109
  1. 1
      libraries/AP_InertialSensor/AP_InertialSensor.cpp
  2. 4
      libraries/AP_InertialSensor/AP_InertialSensor.h

1
libraries/AP_InertialSensor/AP_InertialSensor.cpp

@ -434,6 +434,7 @@ AP_InertialSensor::init(Sample_rate sample_rate) @@ -434,6 +434,7 @@ AP_InertialSensor::init(Sample_rate sample_rate)
{
// remember the sample rate
_sample_rate = sample_rate;
_loop_delta_t = 1.0f / sample_rate;
if (_gyro_count == 0 && _accel_count == 0) {
_start_backends();

4
libraries/AP_InertialSensor/AP_InertialSensor.h

@ -181,6 +181,9 @@ public: @@ -181,6 +181,9 @@ public:
// return the selected sample rate
Sample_rate get_sample_rate(void) const { return _sample_rate; }
// return the main loop delta_t in seconds
float get_loop_delta_t(void) const { return _loop_delta_t; }
uint16_t error_count(void) const { return 0; }
bool healthy(void) const { return get_gyro_health() && get_accel_health(); }
@ -273,6 +276,7 @@ private: @@ -273,6 +276,7 @@ private:
// the selected sample rate
Sample_rate _sample_rate;
float _loop_delta_t;
// Most recent accelerometer reading
Vector3f _accel[INS_MAX_INSTANCES];

Loading…
Cancel
Save