diff options
Diffstat (limited to 'src/lib/mathlib/math/Matrix.hpp')
| -rw-r--r-- | src/lib/mathlib/math/Matrix.hpp | 12 |
1 files changed, 10 insertions, 2 deletions
diff --git a/src/lib/mathlib/math/Matrix.hpp b/src/lib/mathlib/math/Matrix.hpp index 806f5933a..1e76aae60 100644 --- a/src/lib/mathlib/math/Matrix.hpp +++ b/src/lib/mathlib/math/Matrix.hpp @@ -49,9 +49,8 @@ #ifdef CONFIG_ARCH_ARM #include "../CMSIS/Include/arm_math.h" #else -#include <math/eigen_math.h> +#include <platforms/ros/eigen_math.h> #include <Eigen/Eigen> -#define M_PI_2_F 1.5707963267948966192f #endif namespace math @@ -122,6 +121,15 @@ public: memcpy(data, d, sizeof(data)); } +#if defined(__linux) || (defined(__APPLE__) && defined(__MACH__)) + /** + * set data from boost::array + */ + void set(const boost::array<float, 9ul> d) { + set(static_cast<const float*>(d.data())); + } +#endif + /** * access by index */ |