robot

Dependencies:   FastPWM3 mbed

Revision:
98:1051c4103900
Parent:
93:e7e45957f496
Child:
100:d100eb7d80ed
--- a/main.cpp	Sun Apr 09 23:33:10 2017 +0000
+++ b/main.cpp	Tue Apr 11 21:51:52 2017 +0000
@@ -151,8 +151,9 @@
 }
 
 void log() {
-    io.pc->printf("%d,%d,%d,%d,%d,%d,%d,%d\n", (int) read.w, (int) control.d_ref, (int) control.d_filtered, (int) control.q_ref, (int) control.q_filtered, (int) (255 * control.torque_percent), 
-                        (int) (255 * foc.vd), (int) (255 * foc.vq));
+    //io.pc->printf("%d,%d,%d,%d,%d,%d,%d,%d\n", (int) read.w, (int) control.d_ref, (int) control.d_filtered, (int) control.q_ref, (int) control.q_filtered, (int) (255 * control.torque_percent), 
+    //                    (int) (255 * foc.vd), (int) (255 * foc.vq));
+    io.pc->printf("%d,%d\n", (int) control.q_filtered, (int) (255 * foc.vq));
     //io.pc->printf("%d\n", (int) (io.throttle_in->get_usecs()));
     wait(1.0f / LOG_FREQUENCY);
 }
@@ -178,7 +179,7 @@
 }
 
 int main() {
-    dq = new LutMapper();
+    dq = new LutMapper();//AngleMapper(3.0f * PI / 4.0f, 50);
     th = new NullThrottleMapper();
     BREMSInit(&io, &read, &foc, &control, false);