Diff: examples/drvdiag/driver_wrapper/cn0216_diag.cpp

Revision:

13:66c8e4ce4ff1

Child:

17:b8356808e8ad

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/examples/drvdiag/driver_wrapper/cn0216_diag.cpp	Fri Apr 29 16:19:00 2016 +0300
@@ -0,0 +1,35 @@
+#include "mbed.h"
+#include <stdio.h>
+#include <vector>
+#include <string>
+
+#include "cn0216_diag.h"
+
+extern Serial pc;
+extern vector<string> cmdbuffer;
+
+CN0216_Diag::CN0216_Diag(CN0216& cn) : dut(cn)
+{
+
+}
+
+void CN0216_Diag::init(void)
+{
+    uint16_t weight = strtol(cmdbuffer[1].c_str(), NULL, 10);
+    pc.printf("CN0216 initialized with %d calibration weight",weight);
+    dut.init(weight);
+}
+
+void CN0216_Diag::calibrate(void)
+{
+    uint8_t step = strtol(cmdbuffer[1].c_str(), NULL, 16);
+    pc.printf("Calibrating step %d ..",step);
+    dut.calibrate(static_cast<CN0216::CalibrationStep_t>(step));
+    pc.printf(".. DONE",step);
+}
+
+void CN0216_Diag::read_weight(void)
+{
+    pc.printf("Read weight is %f", dut.read_weight());
+}
+