Browse Source

AC_Circle: use fast_atan2 to calc bearing from center

This does not save much time because it's only called at initialisation
master
Randy Mackay 11 years ago
parent
commit
915dad2da4
  1. 2
      libraries/AC_WPNav/AC_Circle.cpp

2
libraries/AC_WPNav/AC_Circle.cpp

@ -248,7 +248,7 @@ void AC_Circle::init_start_angle(bool use_heading) @@ -248,7 +248,7 @@ void AC_Circle::init_start_angle(bool use_heading)
_angle = wrap_PI(_ahrs.yaw-PI);
} else {
// get bearing from circle center to vehicle in radians
float bearing_rad = ToRad(90) + atan2f(-(curr_pos.x-_center.x), curr_pos.y-_center.y);
float bearing_rad = ToRad(90) + fast_atan2(-(curr_pos.x-_center.x), curr_pos.y-_center.y);
_angle = wrap_PI(bearing_rad);
}
}

Loading…
Cancel
Save