fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-14 10:07:39 +08:00
Code Issues Packages Projects Releases Wiki Activity

reduce wheel control speed scaling

Browse Source
This commit is contained in:
Andreas Antener 2015-10-02 16:25:14 +02:00 committed by Roman
parent d015fbd678
commit 9c70eb0b63
1 changed files with 2 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

3
src/lib/ecl/attitude_fw/ecl_wheel_controller.cpp
View File

@ -85,7 +85,8 @@ float ECL_WheelController::control_bodyrate(const struct ECL_ControlData &ctl_da
speed = ctl_data.ground_speed;
}
float scaler = 1.0f / speed;
/* only scale a certain amount with speed else the corrections get to small */
float scaler = 0.7f + 0.3f / speed;
/* Calculate body angular rate error */
_rate_error = _rate_setpoint - ctl_data.yaw_rate; //body angular rate error