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

Calc error for logs

Browse Source
This commit is contained in:
Jason Short 2012-01-21 11:57:21 -08:00
parent d2db7cc7b2
commit ab5716c42d
1 changed files with 4 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
ArduCopter/ArduCopter.pde
View File

@ -2007,7 +2007,7 @@ static void update_nav_wp()
{
if(wp_control == LOITER_MODE){
// calc a pitch to the target
// calc error to target
calc_location_error(&next_WP);
// use error as the desired rate towards the target
@ -2064,6 +2064,9 @@ static void update_nav_wp()
//Serial.printf("CIRCLE: angle:%d, dist:%d, X:%d, Y:%d, P:%d, R:%d \n", angleTest, (int)wp_distance , (int)long_error, (int)lat_error, npitch, nroll);
}else if(wp_control == WP_MODE){
// calc error to target
calc_location_error(&next_WP);
int16_t speed = calc_desired_speed(g.waypoint_speed_max);
// use error as the desired rate towards the target
calc_nav_rate(speed);