vmount: avoid reading uninitialized value

matrix::Quatf() calls sinf(), which caused a valgrind warning
This commit is contained in:
Beat Küng 2019-01-17 08:07:06 +01:00
parent 85e59c210d
commit ef54bff4ed
1 changed files with 2 additions and 2 deletions

View File

@ -207,13 +207,13 @@ void OutputBase::_calculate_output_angles(const hrt_abstime &t)
//get the output angles and stabilize if necessary
vehicle_attitude_s vehicle_attitude;
matrix::Eulerf euler;
if (_stabilize[0] || _stabilize[1] || _stabilize[2]) {
orb_copy(ORB_ID(vehicle_attitude), _vehicle_attitude_sub, &vehicle_attitude);
euler = matrix::Quatf(vehicle_attitude.q);
}
matrix::Eulerf euler = matrix::Quatf(vehicle_attitude.q);
for (int i = 0; i < 3; ++i) {
if (_stabilize[i]) {
_angle_outputs[i] = _angle_setpoints[i] - euler(i);