Show misc_angles.c syntax highlighted
/*
*
* Copyright (c) 2003 The Regents of the University of California. All
* rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
*
* - Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
*
* - Neither the name of the University nor the names of its
* contributors may be used to endorse or promote products derived
* from this software without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS''
* AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
* THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A
* PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR
* CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
* EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
* PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
* PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY
* OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
* OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
*
*/
#include <misc.h>
#include <math.h>
float misc_swap_angle(float angle)
{
return angle + 180.0;
}
float misc_normalize_angle(float angle)
{
float result = fmod(angle, 360.0);
if (result < 0) result += 360.0;
return result;
}
float misc_normalize_angle_rad(float rad_angle)
{
float result = fmodf(rad_angle, 2.0 * M_PI);
if (result < 0) result += (2.0 * M_PI);
return result;
}
/* computes absolute difference between two angles */
float misc_angle_abs_diff(float t1, float t2)
{
float diff = fabs(misc_normalize_angle(t1)-misc_normalize_angle(t2));
if (diff > 180) diff = 360.0 - diff;
return diff;
}
float d2r(float deg)
{
return M_PI * (deg / 180.0);
}
float r2d(float rad)
{
return 180.0 * (rad / M_PI);
}
See more files for this project here