Continue on go to goal behaviour

This commit is contained in:
Konstantin Lampalzer 2022-05-27 02:44:52 +02:00
parent 6a1ac72912
commit 92d42be8b8
13 changed files with 161 additions and 35 deletions

View file

@ -2,6 +2,7 @@
#define COMPLIB_SERVER_MATHUTILS_HPP
#include <cstdint>
#include <cmath>
namespace mathUtils {
inline int int_from_bytes(uint8_t *data, int length) {
@ -34,6 +35,11 @@ namespace mathUtils {
i++;
}
}
template<class T>
inline T wrap_angle_to_pi(T angle) {
return atan2(sin(angle), cos(angle));
}
}
#endif // COMPLIB_SERVER_MATHUTILS_HPP