Add ina_write8/16 commands.

Change-Id: I52ae36500b3685aae74fee10f0b04e5e7eee4f75
diff --git a/firmware/app/zedmon/ina233.c b/firmware/app/zedmon/ina233.c
index bc04930..e95abd3 100644
--- a/firmware/app/zedmon/ina233.c
+++ b/firmware/app/zedmon/ina233.c
@@ -269,7 +269,49 @@
     return 0;
 }
 
+static int cmd_ina_write8(int argc, const cmd_args *argv) {
+    if (argc != 3) {
+        printf("usage: ina_233_write8 <reg> <val>\n");
+        return 1;
+    }
+
+    uint8_t reg = argv[1].u;
+    uint8_t data = argv[2].u;
+
+    status_t ret = ina233_write8(reg, data);
+    if (ret != NO_ERROR) {
+        printf("error: %d\n", ret);
+        return 1;
+    }
+
+    printf("%02x: %02x\n", reg, data);
+
+    return 0;
+}
+
+static int cmd_ina_write16(int argc, const cmd_args *argv) {
+    if (argc != 3) {
+        printf("usage: ina_233_write16 <reg> <val>\n");
+        return 1;
+    }
+
+    uint8_t reg = argv[1].u;
+    uint16_t data = argv[2].u;
+
+    status_t ret = ina233_write16(reg, data);
+    if (ret != NO_ERROR) {
+        printf("error: %d\n", ret);
+        return 1;
+    }
+
+    printf("%02x: %04x\n", reg, data);
+
+    return 0;
+}
+
 STATIC_COMMAND_START
 STATIC_COMMAND("ina_read8", "read an ina233 register", &cmd_ina_read8)
 STATIC_COMMAND("ina_read16", "read an ina233 register", &cmd_ina_read16)
+STATIC_COMMAND("ina_write8", "write an ina233 register", &cmd_ina_write8)
+STATIC_COMMAND("ina_write16", "write an ina233 register", &cmd_ina_write16)
 STATIC_COMMAND_END(ina233);