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

Store prev velocity at right location

Browse Source
This commit is contained in:
Lorenz Meier 2015-12-07 14:57:31 +01:00
parent 7b06c4afb9
commit f533f6ce19
1 changed files with 3 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
src/modules/mc_pos_control/mc_pos_control_main.cpp
View File

@ -1599,6 +1599,9 @@ MulticopterPositionControl::task_main()
_mode_auto = false;
reset_int_z = true;
reset_int_xy = true;
/* store last velocity in case a mode switch to position control occurs */
_vel_sp_prev = _vel;
}
/* generate attitude setpoint from manual controls */
@ -1658,8 +1661,6 @@ MulticopterPositionControl::task_main()
/* update previous velocity for velocity controller D part */
_vel_prev = _vel;
/* store last velocity in case a mode switch to auto occurs */
_vel_sp_prev = _vel;
/* publish attitude setpoint
* Do not publish if offboard is enabled but position/velocity control is disabled,