versuch1

Dependencies:   mbed servo

Committer:
corsa1600
Date:
Mon Jun 24 05:37:34 2019 +0000
Revision:
0:b6a2be4fcb71
versuch1

Who changed what in which revision?

UserRevisionLine numberNew 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 }