zrzk
/
ardupilot
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity
Browse Source

removed debugging 

git-svn-id: https://arducopter.googlecode.com/svn/trunk@1561 f9c3cf11-9bcb-44bc-f272-b75c42450872
mission-4.1.18
jasonshort 14 years ago
parent
e6fe75c9aa
commit
0b2008f581
1 changed files with 3 additions and 3 deletions
Whitespace
Show all changes Ignore whitespace when comparing lines Ignore changes in amount of whitespace Ignore changes in whitespace at EOL
Split View
Diff Options
Show Stats Download Patch File Download Diff File
  1. 6
      ArduCopterMega/navigation.pde

6
ArduCopterMega/navigation.pde
Unescape View File

@ -71,9 +71,9 @@ void calc_nav() @@ -71,9 +71,9 @@ void calc_nav()
// rotate the vector
nav_roll = (float)nav_lat * yawvector.x - (float)nav_lon * yawvector.y;
nav_pitch = (float)nav_lon * yawvector.x + (float)nav_lat * yawvector.y;
Serial.printf("vx %4.4f,vy %4.4f, nr %ld, np %ld ", yawvector.x, yawvector.y, nav_roll, nav_pitch);
//nav_roll = constrain(nav_roll, -pitch_max, pitch_max);
//nav_pitch = constrain(nav_pitch, -pitch_max, pitch_max);
//Serial.printf("vx %4.4f,vy %4.4f, nr %ld, np %ld ", yawvector.x, yawvector.y, nav_roll, nav_pitch);
nav_roll = constrain(nav_roll, -pitch_max, pitch_max);
nav_pitch = constrain(nav_pitch, -pitch_max, pitch_max);
}
/*

Write Preview
Loading…
Cancel
Save