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:29:20 +0100 |
commit | 85aa6554ad90e392a9538006f8cc483d481f0bbd (patch) | |
tree | 91609ea780f56297b6810b960159772f78c713e9 /src | |
parent | 2f646e7082b49ef92bf9be1defd6fb7fdeec8480 (diff) | |
download | px4-firmware-85aa6554ad90e392a9538006f8cc483d481f0bbd.tar.gz px4-firmware-85aa6554ad90e392a9538006f8cc483d481f0bbd.tar.bz2 px4-firmware-85aa6554ad90e392a9538006f8cc483d481f0bbd.zip |
re-add hardcoded parameters for euroc
Diffstat (limited to 'src')
-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; |