Lu-Hsuan Chen
/
motorcar_pid
motor car with PID running feature
Diff: motorcar/motorcar.cpp
- 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); }