Lu-Hsuan Chen
/
motorcar_pid
motor car with PID running feature
motorcar/motorcar.h@2:1dcd81fdef9e, 2018-07-31 (annotated)
- Committer:
- cudaChen
- Date:
- Tue Jul 31 08:09:05 2018 +0000
- Revision:
- 2:1dcd81fdef9e
- Child:
- 3:4be8f486a120
[add] add files motorcar.h and motorcar.cpp
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
cudaChen | 2:1dcd81fdef9e | 1 | #ifndef MOTORCAR_H |
cudaChen | 2:1dcd81fdef9e | 2 | #define MOTORCAR_H |
cudaChen | 2:1dcd81fdef9e | 3 | |
cudaChen | 2:1dcd81fdef9e | 4 | #include "mbed.h" |
cudaChen | 2:1dcd81fdef9e | 5 | |
cudaChen | 2:1dcd81fdef9e | 6 | //#include "Ping.h" |
cudaChen | 2:1dcd81fdef9e | 7 | |
cudaChen | 2:1dcd81fdef9e | 8 | // output used for controlling motors |
cudaChen | 2:1dcd81fdef9e | 9 | extern AnalogOut M1_enable; |
cudaChen | 2:1dcd81fdef9e | 10 | extern AnalogOut M2_enable; |
cudaChen | 2:1dcd81fdef9e | 11 | extern DigitalOut M1_in1; // connected to right motor (IN1) |
cudaChen | 2:1dcd81fdef9e | 12 | extern DigitalOut M1_in2; // connected to right motor (IN2) |
cudaChen | 2:1dcd81fdef9e | 13 | extern DigitalOut M2_in3; // connected to left motor (IN3) |
cudaChen | 2:1dcd81fdef9e | 14 | extern DigitalOut M2_in4; // connected to left motor (IN4) |
cudaChen | 2:1dcd81fdef9e | 15 | |
cudaChen | 2:1dcd81fdef9e | 16 | // input used for IR sensors |
cudaChen | 2:1dcd81fdef9e | 17 | extern AnalogIn leftIR; // left sensor |
cudaChen | 2:1dcd81fdef9e | 18 | extern AnalogIn middleIR; // middle sensor |
cudaChen | 2:1dcd81fdef9e | 19 | extern AnalogIn rightIR; // right sensor |
cudaChen | 2:1dcd81fdef9e | 20 | |
cudaChen | 2:1dcd81fdef9e | 21 | // input used for ultrasonic sensors |
cudaChen | 2:1dcd81fdef9e | 22 | //Ping ultrasonic(D13); |
cudaChen | 2:1dcd81fdef9e | 23 | |
cudaChen | 2:1dcd81fdef9e | 24 | void readSensorValue(); |
cudaChen | 2:1dcd81fdef9e | 25 | void runPID(); |
cudaChen | 2:1dcd81fdef9e | 26 | |
cudaChen | 2:1dcd81fdef9e | 27 | // some functions used for direction of motor car |
cudaChen | 2:1dcd81fdef9e | 28 | void init(); |
cudaChen | 2:1dcd81fdef9e | 29 | void speed(int left, int right); |
cudaChen | 2:1dcd81fdef9e | 30 | |
cudaChen | 2:1dcd81fdef9e | 31 | #endif /* motorcar_pid.h */ |