fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-26 06:53:34 +08:00
Code Issues Packages Projects Releases Wiki Activity

re-add hardcoded parameters for euroc

Browse Source
This commit is contained in:
Thomas Gubler
2014-12-05 09:30:28 +01:00
parent 1c19d75cf4
commit dfd2098e04
1 changed files with 29 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/mc_att_control/mc_att_control_sim.cpp
+29
View File
@@ -46,6 +46,35 @@
using namespace std; using namespace std;
#endif #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) void MulticopterAttitudeControlSim::set_attitude(const Eigen::Quaternion<double> attitude)
{ {
math::Quaternion quat; math::Quaternion quat;