status now always reports position

Firmware/commonSrc/Commands.cpp

@@ -2,6 +2,16 @@
 
 #include "common/Commands.h"
 
+Command::Command(CommandType type, float arg1, float arg2, float arg3,
+                 float arg4, float arg5, float arg6)
+    : type(type),
+      arg1(arg1),
+      arg2(arg2),
+      arg3(arg3),
+      arg4(arg4),
+      arg5(arg5),
+      arg6(arg6){};
+
 Command::Command(float *floats) { fromFloats(floats); }
 
 void Command::fromFloats(float *floats) {
@@ -41,13 +51,3 @@ void Command::toBytes(byte *bytes) {
         floatToBytes(&bytes[i * i2cFloatSize], floats[i]);
     }
 }
-
-void bytesToFloat(float *target, byte *val) {
-    memcpy(target, val, i2cFloatSize);
-    return;
-}
-
-void floatToBytes(byte *target, float val) {
-    memcpy(target, &val, i2cFloatSize);
-    return;
-}

Firmware/commonSrc/Status.cpp

@@ -0,0 +1,54 @@
+#include "common/Status.h"
+
+Status::Status(StatusType type, float mmS, float mmE, float pEng,
+               float feedrate, float eggDia, float eggLen, float xLim)
+    : type(type),
+      mmS(mmS),
+      mmE(mmE),
+      pEng(pEng),
+      feedrate(feedrate),
+      eggDia(eggDia),
+      eggLen(eggLen),
+      xLim(xLim){};
+
+Status::Status(float *floats) { fromFloats(floats); }
+
+void Status::fromFloats(float *floats) {
+    type = static_cast<StatusType>(floats[0]);
+    mmS = floats[1];
+    mmE = floats[2];
+    pEng = floats[3];
+    feedrate = floats[4];
+    eggDia = floats[5];
+    eggLen = floats[6];
+    xLim = floats[7];
+}
+
+void Status::toFloats(float *floats) {
+    floats[0] = static_cast<float>(type);
+    floats[1] = mmS;
+    floats[2] = mmE;
+    floats[3] = pEng;
+    floats[4] = feedrate;
+    floats[5] = eggDia;
+    floats[6] = eggLen;
+    floats[7] = xLim;
+}
+
+Status::Status(byte *bytes) { fromBytes(bytes); }
+
+void Status::fromBytes(byte *bytes) {
+    float floats[i2cStsFloats];
+    for (int i = 0; i < i2cStsFloats; i++) {
+        bytesToFloat(&floats[i], &bytes[i * i2cFloatSize]);
+    }
+    fromFloats(floats);
+}
+
+void Status::toBytes(byte *bytes) {
+    float floats[i2cStsFloats];
+    toFloats(floats);
+    for (int i = 0; i < 7; i++) {
+        floatToBytes(&bytes[i * i2cFloatSize], floats[i]);
+    }
+}