mirror of
https://github.com/ArduPilot/ardupilot
synced 2025-01-12 10:58:30 -04:00
Fix for reversed pitch in SIMPLE mode.
git-svn-id: https://arducopter.googlecode.com/svn/trunk@1779 f9c3cf11-9bcb-44bc-f272-b75c42450872
This commit is contained in:
parent
42caba7d8e
commit
94d34ad117
@ -104,8 +104,8 @@ void calc_waypoint_nav()
|
|||||||
//Serial.printf("X%2.4f, Y%2.4f ", cos_nav_x, sin_nav_y);
|
//Serial.printf("X%2.4f, Y%2.4f ", cos_nav_x, sin_nav_y);
|
||||||
|
|
||||||
// rotate the vector
|
// rotate the vector
|
||||||
nav_roll = (float)nav_lat * cos_nav_x;
|
nav_roll = (float)nav_lat * cos_nav_x;
|
||||||
nav_pitch = (float)nav_lat * sin_nav_y;
|
nav_pitch = -(float)nav_lat * sin_nav_y;
|
||||||
|
|
||||||
//Serial.printf("R%ld, P%ld ", nav_roll, nav_pitch);
|
//Serial.printf("R%ld, P%ld ", nav_roll, nav_pitch);
|
||||||
|
|
||||||
|
Loading…
Reference in New Issue
Block a user