[rotorcraft] navigation: fix NavCircleCount

This commit is contained in:
Felix Ruess
2014-11-25 15:03:34 +01:00
parent 4f39d2ab7e
commit 53d7f27fe0
@@ -135,7 +135,7 @@ extern void nav_circle(struct EnuCoor_i * wp_center, int32_t radius);
nav_circle(&waypoints[_center], POS_BFP_OF_REAL(_radius)); \
}
#define NavCircleCount() (abs(nav_circle_radians) / INT32_ANGLE_2_PI)
#define NavCircleCount() ((float)abs(nav_circle_radians) / INT32_ANGLE_2_PI)
#define NavCircleQdr() ({ int32_t qdr = INT32_DEG_OF_RAD(INT32_ANGLE_2_PI_2 - nav_circle_qdr) >> INT32_ANGLE_FRAC; NormCourse(qdr); qdr; })
/** True if x (in degrees) is close to the current QDR (less than 10 degrees)*/