add matrix copyTo

This commit is contained in:
Daniel Agar
2017-02-25 11:04:02 +01:00
committed by Lorenz Meier
parent f43f3baa02
commit ecb2511a7b
6 changed files with 37 additions and 75 deletions
@@ -1001,10 +1001,7 @@ FixedwingAttitudeControl::task_main()
_att_sp.thrust = _manual.z;
Quatf q(Eulerf(_att_sp.roll_body, _att_sp.pitch_body, _att_sp.yaw_body));
_att_sp.q_d[0] = q(0);
_att_sp.q_d[1] = q(1);
_att_sp.q_d[2] = q(2);
_att_sp.q_d[3] = q(3);
q.copyTo(_att_sp.q_d);
_att_sp.q_d_valid = true;
int instance;