Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-02-26 01:33:56 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_Math: fix up rotation test suite

Browse Source
This commit is contained in:
Jonathan Challinger 2014-10-19 11:52:14 -07:00 committed by Andrew Tridgell
parent 6076f3fa22
commit 70845882a7
1 changed files with 4 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
libraries/AP_Math/examples/eulers/eulers.pde
View File

@ -33,6 +33,7 @@
#include <AP_Airspeed.h>
#include <AP_Vehicle.h>
#include <AP_ADC_AnalogSource.h>
#include <AP_Rally.h>
const AP_HAL::HAL& hal = AP_HAL_BOARD_DRIVER;
@ -132,7 +133,7 @@ static void test_quaternion(float roll, float pitch, float yaw)
float roll2, pitch2, yaw2;
q.from_euler(roll, pitch, yaw);
q.to_euler(&roll2, &pitch2, &yaw2);
q.to_euler(roll2, pitch2, yaw2);
check_result("test_quaternion1", roll, pitch, yaw, roll2, pitch2, yaw2);
m.from_euler(roll, pitch, yaw);
@ -141,7 +142,7 @@ static void test_quaternion(float roll, float pitch, float yaw)
m.from_euler(roll, pitch, yaw);
q.from_rotation_matrix(m);
q.to_euler(&roll2, &pitch2, &yaw2);
q.to_euler(roll2, pitch2, yaw2);
check_result("test_quaternion3", roll, pitch, yaw, roll2, pitch2, yaw2);
q.rotation_matrix(m);
@ -192,7 +193,7 @@ static void test_conversion(float roll, float pitch, float yaw)
float roll3, pitch3, yaw3;
q.from_euler(roll, pitch, yaw);
q.to_euler(&roll2, &pitch2, &yaw2);
q.to_euler(roll2, pitch2, yaw2);
check_result("test_conversion1", roll, pitch, yaw, roll2, pitch2, yaw2);
q.rotation_matrix(m);