140_robot_H_Bridge8835_DIR_PWM_US_LCD
Dependencies: HCSR04 LCD_i2C_JDS
main.cpp@0:7f52b9bd4591, 2022-02-23 (annotated)
- Committer:
- itbusch
- Date:
- Wed Feb 23 18:53:14 2022 +0000
- Revision:
- 0:7f52b9bd4591
140_robot_H_Bridge8835_DIR_PWM_US_LCD
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
itbusch | 0:7f52b9bd4591 | 1 | /* mbed BuschA |
itbusch | 0:7f52b9bd4591 | 2 | */ |
itbusch | 0:7f52b9bd4591 | 3 | |
itbusch | 0:7f52b9bd4591 | 4 | #include "mbed.h" |
itbusch | 0:7f52b9bd4591 | 5 | #include "HCSR04.h" //US-Sensor Abstand |
itbusch | 0:7f52b9bd4591 | 6 | #include "UP_US_Sensor.h" |
itbusch | 0:7f52b9bd4591 | 7 | #include "LCD.h" |
itbusch | 0:7f52b9bd4591 | 8 | #include "LCD_Bua.h" |
itbusch | 0:7f52b9bd4591 | 9 | |
itbusch | 0:7f52b9bd4591 | 10 | DigitalIn CableSwitch(D2); //PullUp auf Board, PA_10 |
itbusch | 0:7f52b9bd4591 | 11 | PwmOut M1_PWM(D9); |
itbusch | 0:7f52b9bd4591 | 12 | DigitalOut M1_DIR(D7); |
itbusch | 0:7f52b9bd4591 | 13 | |
itbusch | 0:7f52b9bd4591 | 14 | int main() |
itbusch | 0:7f52b9bd4591 | 15 | { |
itbusch | 0:7f52b9bd4591 | 16 | sensor.setRanges(10, 110); |
itbusch | 0:7f52b9bd4591 | 17 | sensor.getMinRange(), sensor.getMaxRange(); |
itbusch | 0:7f52b9bd4591 | 18 | M1_PWM.period_ms(10); // PWM-Periode |
itbusch | 0:7f52b9bd4591 | 19 | M1_DIR = 1; // Vorwärts... |
itbusch | 0:7f52b9bd4591 | 20 | M1_PWM = 0.8; //Start-Speed |
itbusch | 0:7f52b9bd4591 | 21 | |
itbusch | 0:7f52b9bd4591 | 22 | while (1) |
itbusch | 0:7f52b9bd4591 | 23 | { |
itbusch | 0:7f52b9bd4591 | 24 | |
itbusch | 0:7f52b9bd4591 | 25 | Abstandsmessung(); //Abstand in cm |
itbusch | 0:7f52b9bd4591 | 26 | |
itbusch | 0:7f52b9bd4591 | 27 | switch (Abstand) |
itbusch | 0:7f52b9bd4591 | 28 | { |
itbusch | 0:7f52b9bd4591 | 29 | case 50: M1_PWM = 0.1; break; |
itbusch | 0:7f52b9bd4591 | 30 | case 100: M1_PWM = 0.3; break; |
itbusch | 0:7f52b9bd4591 | 31 | case 150: M1_PWM = 0.5; break; |
itbusch | 0:7f52b9bd4591 | 32 | case 200: M1_PWM = 0.7; break; |
itbusch | 0:7f52b9bd4591 | 33 | case 250: M1_PWM = 0.9; break; |
itbusch | 0:7f52b9bd4591 | 34 | case 300: M1_PWM = 1.0; break; |
itbusch | 0:7f52b9bd4591 | 35 | } |
itbusch | 0:7f52b9bd4591 | 36 | |
itbusch | 0:7f52b9bd4591 | 37 | } |
itbusch | 0:7f52b9bd4591 | 38 | thread_sleep_for(200); //Sleep = Warten... |
itbusch | 0:7f52b9bd4591 | 39 | } |