To receive notifications about scheduled maintenance, please subscribe to the mailing-list gitlab-operations@sympa.ethz.ch. You can subscribe to the mailing-list at https://sympa.ethz.ch

Commit fbfb4d22 authored by beuchatp's avatar beuchatp
Browse files

finally corrected body rate commands for current yaw angle

parent d0d46649
......@@ -656,8 +656,8 @@ void desired_eulerrates_to_bodyrates( Controller::Request &request , float roll_
float sinYaw = sin(yaw);
float cosYaw = cos(yaw);
bodyrates[0] = roll_rate * cosYaw + pitch_rate * sinYaw;
bodyrates[1] = -roll_rate * sinYaw + pitch_rate * cosYaw;
bodyrates[0] = roll_rate * cosYaw - pitch_rate * sinYaw;
bodyrates[1] = roll_rate * sinYaw + pitch_rate * cosYaw;
return;
......
Markdown is supported
0% or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment