Continue on go to goal behaviour
This commit is contained in:
parent
6a1ac72912
commit
92d42be8b8
13 changed files with 161 additions and 35 deletions
|
@ -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
|
Reference in a new issue