ArduCopter: remove unused functions wrap_360f, wrap_180f and wrap_PI

This commit is contained in:
rmackay9 2012-11-08 15:20:08 +09:00
parent 97d85de361
commit 2b714ff7b0
1 changed files with 1 additions and 23 deletions

View File

@ -609,26 +609,4 @@ static int32_t wrap_180(int32_t error)
if (error > 18000) error -= 36000;
if (error < -18000) error += 36000;
return error;
}
static float wrap_360f(float angle_in_degrees)
{
if (angle_in_degrees > 36000) angle_in_degrees -= 36000;
if (angle_in_degrees < 0) angle_in_degrees += 36000;
return angle_in_degrees;
}
static float wrap_180f(float angle_in_degrees)
{
if (angle_in_degrees > 18000) angle_in_degrees -= 36000;
if (angle_in_degrees < -18000) angle_in_degrees += 36000;
return angle_in_degrees;
}
static float wrap_PI(float angle_in_radians)
{
if (angle_in_radians > M_PI) angle_in_radians -= 2.0*M_PI;
if (angle_in_radians < -M_PI) angle_in_radians += 2.0*M_PI;
return angle_in_radians;
}
}