Oliver Ainhirn
/
last
versuch1
main.cpp@0:b6a2be4fcb71, 2019-06-24 (annotated)
- Committer:
- corsa1600
- Date:
- Mon Jun 24 05:37:34 2019 +0000
- Revision:
- 0:b6a2be4fcb71
versuch1
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
corsa1600 | 0:b6a2be4fcb71 | 1 | // Steuerung des R-Servo mit Tasten |
corsa1600 | 0:b6a2be4fcb71 | 2 | |
corsa1600 | 0:b6a2be4fcb71 | 3 | #include "mbed.h" |
corsa1600 | 0:b6a2be4fcb71 | 4 | #include "servo.h" |
corsa1600 | 0:b6a2be4fcb71 | 5 | |
corsa1600 | 0:b6a2be4fcb71 | 6 | DigitalIn Rechts(P0_15); |
corsa1600 | 0:b6a2be4fcb71 | 7 | DigitalIn Links(P0_10); |
corsa1600 | 0:b6a2be4fcb71 | 8 | DigitalIn RangePlus(P0_23); |
corsa1600 | 0:b6a2be4fcb71 | 9 | DigitalIn RangeMinus(P1_16); |
corsa1600 | 0:b6a2be4fcb71 | 10 | |
corsa1600 | 0:b6a2be4fcb71 | 11 | Servo myservo(P0_8); // p6 |
corsa1600 | 0:b6a2be4fcb71 | 12 | |
corsa1600 | 0:b6a2be4fcb71 | 13 | int main() |
corsa1600 | 0:b6a2be4fcb71 | 14 | { |
corsa1600 | 0:b6a2be4fcb71 | 15 | float range = 0.0005; |
corsa1600 | 0:b6a2be4fcb71 | 16 | float position = 0.5; |
corsa1600 | 0:b6a2be4fcb71 | 17 | |
corsa1600 | 0:b6a2be4fcb71 | 18 | while(1) |
corsa1600 | 0:b6a2be4fcb71 | 19 | { |
corsa1600 | 0:b6a2be4fcb71 | 20 | if(Rechts) |
corsa1600 | 0:b6a2be4fcb71 | 21 | position = 0.0; |
corsa1600 | 0:b6a2be4fcb71 | 22 | if(Links) |
corsa1600 | 0:b6a2be4fcb71 | 23 | position = 1.0; |
corsa1600 | 0:b6a2be4fcb71 | 24 | if(Rechts && Links) |
corsa1600 | 0:b6a2be4fcb71 | 25 | { |
corsa1600 | 0:b6a2be4fcb71 | 26 | position = 0.5; |
corsa1600 | 0:b6a2be4fcb71 | 27 | wait_ms(100); |
corsa1600 | 0:b6a2be4fcb71 | 28 | } |
corsa1600 | 0:b6a2be4fcb71 | 29 | if(RangePlus) |
corsa1600 | 0:b6a2be4fcb71 | 30 | { |
corsa1600 | 0:b6a2be4fcb71 | 31 | range += 0.0001; |
corsa1600 | 0:b6a2be4fcb71 | 32 | wait_ms(100); |
corsa1600 | 0:b6a2be4fcb71 | 33 | } |
corsa1600 | 0:b6a2be4fcb71 | 34 | if(RangeMinus) |
corsa1600 | 0:b6a2be4fcb71 | 35 | { |
corsa1600 | 0:b6a2be4fcb71 | 36 | range -= 0.0001; |
corsa1600 | 0:b6a2be4fcb71 | 37 | wait_ms(100); |
corsa1600 | 0:b6a2be4fcb71 | 38 | } |
corsa1600 | 0:b6a2be4fcb71 | 39 | myservo.calibrate(range, 45.0); |
corsa1600 | 0:b6a2be4fcb71 | 40 | myservo = position; |
corsa1600 | 0:b6a2be4fcb71 | 41 | wait_ms(500); |
corsa1600 | 0:b6a2be4fcb71 | 42 | } |
corsa1600 | 0:b6a2be4fcb71 | 43 | } |