Bruno Allaire-Lemay
/
APP1test
df
Fork of APP1 by
Diff: Utility.cpp
- Revision:
- 6:3facf0329142
- Child:
- 9:12519f9dd3cd
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/Utility.cpp Sun Jan 15 02:04:23 2017 +0000 @@ -0,0 +1,24 @@ +#include "Utility.hpp" + +#include <cmath> + +namespace utility +{ + bool is_almost_equal(double a, double b, double tolerance) + { + double difference = std::abs(a-b); + return (difference <= tolerance); + } + + //Return angle between 0 and 360 degree + double wrap_angle(double angle) + { + return angle - 360 * std::floor( angle / 360 ); + } + + double degree_from_radian(const double angle_radian) + { + const double angle_degree = angle_radian * 180.0 / PI; + return wrap_angle(angle_degree); + } +}; \ No newline at end of file