Skip to content

Commit

Permalink
mc pos multi: set R valid in attitude sp in manual mode
Browse files Browse the repository at this point in the history
  • Loading branch information
thomasgubler committed Feb 22, 2015
1 parent 72fa3e3 commit c4ec654
Showing 1 changed file with 1 addition and 0 deletions.
Original file line number Diff line number Diff line change
Expand Up @@ -1007,6 +1007,7 @@ void MulticopterPositionControl::handle_vehicle_attitude(const px4_vehicle_atti
/* Construct attitude setpoint rotation matrix */
math::Matrix<3,3> R_sp;
R_sp.from_euler(_att_sp_msg.data().roll_body,_att_sp_msg.data().pitch_body,_att_sp_msg.data().yaw_body);
_att_sp_msg.data().R_valid = true;
memcpy(&_att_sp_msg.data().R_body[0], R_sp.data, sizeof(_att_sp_msg.data().R_body));
_att_sp_msg.data().timestamp = get_time_micros();
}
Expand Down

0 comments on commit c4ec654

Please sign in to comment.