     }
     bytes[i++] = (uint8_t) b;
   }
-  /*Serial.print("< ");
+  /*HWSerial.print("< ");
   for (i = 0; i < len; i++) {
-    Serial.print(bytes[i],HEX);
-    Serial.print(" ");
-  }
-  Serial.println();*/
-}
+    HWSerial.print(bytes[i],HEX);
+    HWSerial.print(" ");
+  }
+  HWSerial.println();*/
+}

  packet = readCommand();
  //If NAK error, otherwise return param
  uint32_t param = packet->param;
  uint16_t cmd = packet->cmd;
  free(packet);
  return param;
}

  CommandPacket* cmd = getCommand(CLOSE);
  sendCommand(cmd);
  free(cmd);
  HWSerial.end();
  setup();*/
}

