Merge branch 'offboard2' of https://github.com/elikos/Firmware into offboard2

This commit is contained in:
Benjamin O'Connell-Armand
2014-06-14 15:50:24 -04:00
2 changed files with 5 additions and 5 deletions
@@ -681,12 +681,12 @@ MulticopterPositionControl::task_main()
/* Make sure position control is selected i.e. not only velocity control */
if (_control_mode.flag_control_position_enabled) {
_pos_sp(0) = _local_pos_sp.x;
_pos_sp(1) = _local_pos_sp.y;
_pos_sp(0) = _local_pos_sp.x;
_pos_sp(1) = _local_pos_sp.y;
}
if (_control_mode.flag_control_altitude_enabled) {
_pos_sp(2) = _local_pos_sp.z;
_pos_sp(2) = _local_pos_sp.z;
}
_att_sp.yaw_body = _local_pos_sp.yaw;