Lu-Hsuan Chen
/
autocar_3sensor_mbed
An auto car with 3 IR sensors.
Diff: autocar/autocar.h
- Revision:
- 15:1d440beb24d3
- Parent:
- 13:87cd0ae37e06
- Child:
- 18:d7509436e9ef
--- a/autocar/autocar.h Sun Jul 01 13:12:37 2018 +0000 +++ b/autocar/autocar.h Thu Jul 05 09:33:33 2018 +0000 @@ -3,25 +3,20 @@ #include "mbed.h" -// used for motor -//AnalogOut M1_enable(D6); -//AnalogOut M2_enable(D5); -/*DigitalOut M1_enable(D6); -DigitalOut M2_enable(D5); -DigitalOut M1_in1(D3); -DigitalOut M1_in2(D2); -DigitalOut M2_in3(D1); -DigitalOut M2_in4(D0); -const int MOTOR_M1 = 0; -const int MOTOR_M2 = 1; -const int DIR_FORWARD = 0; -const int DIR_BACKWARD = 1; -const int PWR_STOP = 0;*/ +// used for motors +extern DigitalOut M1_enable; +extern DigitalOut M2_enable; +extern DigitalOut M1_in1; +extern DigitalOut M1_in2; +extern DigitalOut M2_in3; +extern DigitalOut M2_in4; // used for IR sensors -/*AnalogIn leftIR(A1); -AnalogIn middleIR(A3); -AnalogIn rightIR(A5);*/ +extern AnalogIn leftIR; +extern AnalogIn middleIR; +extern AnalogIn rightIR; + +// read the value of IR sensors void readIR(bool* left, bool* middle, bool* right, int threshold); int readIRValues(); @@ -30,7 +25,6 @@ // used for controlling the direction of auto car void DriveSingleMotor(int m, int speed, int dir); void driveMotor(bool left, bool middle, bool right); - void driveMotorPID(int values, float Kp, float Ki, float Kd); void init();