mirror of
https://github.com/ArduPilot/ardupilot
synced 2025-01-04 15:08:28 -04:00
716c124f73
Gain definitions in roll and pitch controllers were updated previously so that the old PID tuning values could be transferred across. Updated tuning guide for revised gain definition.
40 lines
768 B
C++
40 lines
768 B
C++
// -*- tab-width: 4; Mode: C++; c-basic-offset: 4; indent-tabs-mode: nil -*-
|
|
|
|
#ifndef __AP_ROLL_CONTROLLER_H__
|
|
#define __AP_ROLL_CONTROLLER_H__
|
|
|
|
#include <AP_AHRS.h>
|
|
#include <AP_Common.h>
|
|
#include <math.h> // for fabs()
|
|
|
|
class AP_RollController {
|
|
public:
|
|
AP_RollController() {
|
|
AP_Param::setup_object_defaults(this, var_info);
|
|
}
|
|
|
|
void set_ahrs(AP_AHRS *ahrs) { _ahrs = ahrs; }
|
|
|
|
int32_t get_servo_out(int32_t angle, float scaler=1.0, bool stabilize=false, int16_t aspd_min = 0);
|
|
|
|
void reset_I();
|
|
|
|
static const struct AP_Param::GroupInfo var_info[];
|
|
|
|
private:
|
|
AP_Float _tau;
|
|
AP_Float _K_P;
|
|
AP_Float _K_I;
|
|
AP_Float _K_D;
|
|
AP_Int16 _max_rate;
|
|
uint32_t _last_t;
|
|
float _last_out;
|
|
|
|
float _integrator;
|
|
|
|
AP_AHRS *_ahrs;
|
|
|
|
};
|
|
|
|
#endif // __AP_ROLL_CONTROLLER_H__
|