Browse Source

AHRS: new functions to support APM_Control library

master
Andrew Tridgell 13 years ago
parent
commit
8b53f1272a
  1. 13
      libraries/AP_AHRS/AP_AHRS.h

13
libraries/AP_AHRS/AP_AHRS.h

@ -58,6 +58,10 @@ public: @@ -58,6 +58,10 @@ public:
_airspeed = airspeed;
}
IMU* get_imu() {
return _imu;
}
// Methods
virtual void update(void) = 0;
@ -71,6 +75,15 @@ public: @@ -71,6 +75,15 @@ public:
int32_t pitch_sensor;
int32_t yaw_sensor;
float get_pitch_rate_earth(void) {
Vector3f omega = get_gyro();
return cos(roll) * omega.y - sin(roll) * omega.z;
}
float get_roll_rate_earth(void) {
Vector3f omega = get_gyro();
return omega.x + tan(pitch)*(omega.y*sin(roll) + omega.z*cos(roll));
}
// return a smoothed and corrected gyro vector
virtual Vector3f get_gyro(void) = 0;

Loading…
Cancel
Save