Hello
Dependencies: Motor Servo mbed
main.cpp@0:d07fffb33419, 2014-10-09 (annotated)
- Committer:
- m174770
- Date:
- Thu Oct 09 15:31:19 2014 +0000
- Revision:
- 0:d07fffb33419
Kill
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
m174770 | 0:d07fffb33419 | 1 | #include "mbed.h" |
m174770 | 0:d07fffb33419 | 2 | #include "Servo.h" |
m174770 | 0:d07fffb33419 | 3 | #include "Motor.h" |
m174770 | 0:d07fffb33419 | 4 | |
m174770 | 0:d07fffb33419 | 5 | Servo myservo1(p22); //inititalize motors and servo |
m174770 | 0:d07fffb33419 | 6 | DigitalIn sw2(p17); |
m174770 | 0:d07fffb33419 | 7 | DigitalIn sw3(p18); |
m174770 | 0:d07fffb33419 | 8 | |
m174770 | 0:d07fffb33419 | 9 | |
m174770 | 0:d07fffb33419 | 10 | int main() |
m174770 | 0:d07fffb33419 | 11 | { |
m174770 | 0:d07fffb33419 | 12 | float servopos; //current position of servos |
m174770 | 0:d07fffb33419 | 13 | float waittime=0.02; |
m174770 | 0:d07fffb33419 | 14 | while(1) { |
m174770 | 0:d07fffb33419 | 15 | if(sw2==1) { |
m174770 | 0:d07fffb33419 | 16 | servopos=0.5; |
m174770 | 0:d07fffb33419 | 17 | while(sw2==1) { |
m174770 | 0:d07fffb33419 | 18 | servopos+=0.0025; |
m174770 | 0:d07fffb33419 | 19 | wait(waittime); |
m174770 | 0:d07fffb33419 | 20 | myservo1=servopos; |
m174770 | 0:d07fffb33419 | 21 | |
m174770 | 0:d07fffb33419 | 22 | } |
m174770 | 0:d07fffb33419 | 23 | } |
m174770 | 0:d07fffb33419 | 24 | if(sw3==1) { |
m174770 | 0:d07fffb33419 | 25 | servopos=myservo1; |
m174770 | 0:d07fffb33419 | 26 | |
m174770 | 0:d07fffb33419 | 27 | while(sw3==1) { |
m174770 | 0:d07fffb33419 | 28 | servopos-=0.0025; |
m174770 | 0:d07fffb33419 | 29 | wait(waittime); |
m174770 | 0:d07fffb33419 | 30 | myservo1=servopos; |
m174770 | 0:d07fffb33419 | 31 | |
m174770 | 0:d07fffb33419 | 32 | } |
m174770 | 0:d07fffb33419 | 33 | } |
m174770 | 0:d07fffb33419 | 34 | } |
m174770 | 0:d07fffb33419 | 35 | } |
m174770 | 0:d07fffb33419 | 36 | |
m174770 | 0:d07fffb33419 | 37 | |
m174770 | 0:d07fffb33419 | 38 |