status now always reports position

Firmware/common/Commands.h

@@ -1,8 +1,9 @@
 #ifndef COMMANDS_H
 #define COMMANDS_H
 
-constexpr int i2cFloatSize{4}, i2cCmdFloats{7},
-    i2cCmdBytes{i2cFloatSize * i2cCmdFloats};
+#include "common/Util.h"
+
+constexpr int i2cCmdFloats{7}, i2cCmdBytes{i2cFloatSize * i2cCmdFloats};
 
 enum bcAxis {
     X = 1,
@@ -10,13 +11,6 @@ enum bcAxis {
     Z = 3,
 };
 
-enum class I2CStatusMsg {
-    WAIT = 0,
-    NEXT,
-    TIMEOUT,
-    ERR,
-};
-
 enum PosMsg {
     servoRot,
     eggRot,
@@ -43,14 +37,7 @@ struct Command {
 
     Command(CommandType type = CommandType::unk, float arg1 = NAN,
             float arg2 = NAN, float arg3 = NAN, float arg4 = NAN,
-            float arg5 = NAN, float arg6 = NAN)
-        : type(type),
-          arg1(arg1),
-          arg2(arg2),
-          arg3(arg3),
-          arg4(arg4),
-          arg5(arg5),
-          arg6(arg6){};
+            float arg5 = NAN, float arg6 = NAN);
 
     Command(float *floats);
     void fromFloats(float *floats);
@@ -61,7 +48,4 @@ struct Command {
     void toBytes(byte *bytes);
 };
 
-void bytesToFloat(float *target, byte *val);
-void floatToBytes(byte *target, float val);
-
 #endif