mirror of https://github.com/ArduPilot/ardupilot
ArduCopter: remove unused functions wrap_360f, wrap_180f and wrap_PI
This commit is contained in:
parent
77c35d0ae4
commit
fabc149f45
|
@ -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;
|
||||
}
|
||||
|
||||
}
|
Loading…
Reference in New Issue