Publish a4

1 files changed, 19 insertions, 0 deletions

diff --git a/dev/a4-dance/amc_util.h b/dev/a4-dance/amc_util.h
new file mode 100644
index 0000000..5593a3b
--- /dev/null
+++ b/dev/a4-dance/amc_util.h
@@ -0,0 +1,19 @@
+#ifndef AMC_UTIL_H_
+#define AMC_UTIL_H_
+
+#include <mingfx.h>
+
+
+// Converts amc mocap units to meters
+
+inline Point3 amc2meter(Point3 p) {
+    return Point3(p[0] * 0.056444f, p[1] * 0.056444f, p[2] * 0.056444f);
+}
+
+template <typename T>
+T amc2meter(T t) {
+    return t * 0.056444f;
+}
+
+
+#endif