aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Copter: replace sin_yaw_y, cos_yaw_x in circle mode

Browse Source
This commit is contained in:
Randy Mackay 2013-04-13 13:57:04 +09:00
parent 366616e32c
commit 700fb1b179
1 changed files with 2 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
ArduCopter/navigation.pde
View File

@ -227,8 +227,8 @@ static void
circle_set_center(const Vector3f current_position, float heading_in_radians)
{
// set circle center to circle_radius ahead of current position
circle_center.x = current_position.x + (float)g.circle_radius * 100 * sin_yaw_y;
circle_center.y = current_position.y + (float)g.circle_radius * 100 * cos_yaw_x;
circle_center.x = current_position.x + (float)g.circle_radius * 100 * sin_yaw;
circle_center.y = current_position.y + (float)g.circle_radius * 100 * cos_yaw;
// if we are doing a panorama set the circle_angle to the current heading
if( g.circle_radius == 0 ) {