motor car with PID running feature

Dependencies:   Ping

Revision:
4:982dcc2390a2
Parent:
3:4be8f486a120
Child:
5:3caf5b6ed35a
--- a/motorcar/motorcar.cpp	Wed Aug 01 07:18:57 2018 +0000
+++ b/motorcar/motorcar.cpp	Wed Aug 01 08:24:24 2018 +0000
@@ -4,8 +4,8 @@
 //#include "Ping.h"
 
 // output used for controlling motors
-AnalogOut M1_enable(PA_4);
-AnalogOut M2_enable(PA_5);
+AnalogOut M1_enable(PA_4); // right motor enable signal
+AnalogOut M2_enable(PA_5); // left motor enable signal
 DigitalOut M1_in1(D3); // connected to right motor (IN1)
 DigitalOut M1_in2(D2); // connected to right motor (IN2)
 DigitalOut M2_in3(D1); // connected to left motor (IN3)
@@ -31,7 +31,7 @@
 int limit = 65535; // 2^16 - 1
 
 // used for output message via serial for ease of debugging
-Serial pc(SERIAL_TX, SERIAL_RX);
+//Serial pc(SERIAL_TX, SERIAL_RX);
 
 void readSensorValue() {
     left = leftIR.read_u16();
@@ -40,8 +40,8 @@
     
     values = left * (-1) + middle * 0 + right * 1;
 
-    pc.printf("left middle right: %d %d %d\r\n", left, middle, right);
-    wait(1);
+    //pc.printf("left middle right: %d %d %d\r\n", left, middle, right);
+    //wait(1);
     //pc.printf("IR values: %d\r\n", ret);
 }