10 lines
193 B
C++
10 lines
193 B
C++
|
#include "utils.h"
|
||
|
|
|
||
|
|
namespace oh_my_loam {
|
||
|
|
|
||
|
|
double NormalizeAngle(double ang) {
|
||
|
|
const double& two_pi = 2 * M_PI;
|
||
|
|
return ang - two_pi * std::floor((ang + M_PI) / two_pi);
|
||
|
|
}
|
||
|
|
|
||
|
|
} // oh_my_loam
|