diff options
author | Thomas Gubler <thomasgubler@gmail.com> | 2014-12-05 09:29:20 +0100 |
---|---|---|
committer | Thomas Gubler <thomasgubler@gmail.com> | 2014-12-05 09:30:28 +0100 |
commit | dfd2098e04761ee65ab09a9a8e6656a334ccae41 (patch) | |
tree | 5fc60f06f1877fb1f2c00f075dfbae87605fc1fb /src/modules | |
parent | 1c19d75cf429639ff9ab9ff23ad9fbcd1c936e98 (diff) | |
download | px4-firmware-dfd2098e04761ee65ab09a9a8e6656a334ccae41.tar.gz px4-firmware-dfd2098e04761ee65ab09a9a8e6656a334ccae41.tar.bz2 px4-firmware-dfd2098e04761ee65ab09a9a8e6656a334ccae41.zip |
re-add hardcoded parameters for euroc
Diffstat (limited to 'src/modules')
-rw-r--r-- | src/modules/mc_att_control/mc_att_control_sim.cpp | 29 |
1 files changed, 29 insertions, 0 deletions
diff --git a/src/modules/mc_att_control/mc_att_control_sim.cpp b/src/modules/mc_att_control/mc_att_control_sim.cpp index faf729420..a8467f6b1 100644 --- a/src/modules/mc_att_control/mc_att_control_sim.cpp +++ b/src/modules/mc_att_control/mc_att_control_sim.cpp @@ -46,6 +46,35 @@ using namespace std; #endif +MulticopterAttitudeControlSim::MulticopterAttitudeControlSim() +{ + /* setup standard gains */ + //XXX: make these configurable + _params.att_p(0) = 5.0; + _params.rate_p(0) = 0.05; + _params.rate_i(0) = 0.0; + _params.rate_d(0) = 0.003; + /* pitch gains */ + _params.att_p(1) = 5.0; + _params.rate_p(1) = 0.05; + _params.rate_i(1) = 0.0; + _params.rate_d(1) = 0.003; + /* yaw gains */ + _params.att_p(2) = 2.8; + _params.rate_p(2) = 0.2; + _params.rate_i(2) = 0.1; + _params.rate_d(2) = 0.0; + _params.yaw_rate_max = 0.5; + _params.yaw_ff = 0.5; + _params.man_roll_max = 0.6; + _params.man_pitch_max = 0.6; + _params.man_yaw_max = 0.6; +} + +MulticopterAttitudeControlSim::~MulticopterAttitudeControlSim() +{ +} + void MulticopterAttitudeControlSim::set_attitude(const Eigen::Quaternion<double> attitude) { math::Quaternion quat; |