Presentation code for PROJECT #1 - ES200 Fall 2014
Dependencies: Servo mbed Motor
ARM/armmain.cpp@2:f10d71467f13, 2014-10-09 (annotated)
- Committer:
- cstab94
- Date:
- Thu Oct 09 19:16:54 2014 +0000
- Revision:
- 2:f10d71467f13
initialized ARM rc motor code
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
cstab94 | 2:f10d71467f13 | 1 | //Code for the arm servo |
cstab94 | 2:f10d71467f13 | 2 | //Created 09 OCT 14, 3/C Stabler |
cstab94 | 2:f10d71467f13 | 3 | #include "mbed.h" |
cstab94 | 2:f10d71467f13 | 4 | #include "Servo.h" |
cstab94 | 2:f10d71467f13 | 5 | |
cstab94 | 2:f10d71467f13 | 6 | Servo arm(p21); |
cstab94 | 2:f10d71467f13 | 7 | DigitalIn switch1(p16); |
cstab94 | 2:f10d71467f13 | 8 | DigitalIn switch2(p17); |
cstab94 | 2:f10d71467f13 | 9 | |
cstab94 | 2:f10d71467f13 | 10 | int main(){ |
cstab94 | 2:f10d71467f13 | 11 | |
cstab94 | 2:f10d71467f13 | 12 | float armpos; |
cstab94 | 2:f10d71467f13 | 13 | int sw1; |
cstab94 | 2:f10d71467f13 | 14 | int sw2; |
cstab94 | 2:f10d71467f13 | 15 | |
cstab94 | 2:f10d71467f13 | 16 | while(1){ |
cstab94 | 2:f10d71467f13 | 17 | sw1 = switch1.read(); |
cstab94 | 2:f10d71467f13 | 18 | sw2 = switch2.read(); |
cstab94 | 2:f10d71467f13 | 19 | |
cstab94 | 2:f10d71467f13 | 20 | if(sw1 == 1) |
cstab94 | 2:f10d71467f13 | 21 | { |
cstab94 | 2:f10d71467f13 | 22 | for(armpos = 0.0; armpos <= 1.0; armpos += .05){ |
cstab94 | 2:f10d71467f13 | 23 | arm = armpos; |
cstab94 | 2:f10d71467f13 | 24 | wait(.1); |
cstab94 | 2:f10d71467f13 | 25 | } |
cstab94 | 2:f10d71467f13 | 26 | } |
cstab94 | 2:f10d71467f13 | 27 | else if(sw1 == 0) |
cstab94 | 2:f10d71467f13 | 28 | { |
cstab94 | 2:f10d71467f13 | 29 | arm = armpos; |
cstab94 | 2:f10d71467f13 | 30 | } |
cstab94 | 2:f10d71467f13 | 31 | else if(sw2 == 1) |
cstab94 | 2:f10d71467f13 | 32 | { |
cstab94 | 2:f10d71467f13 | 33 | for(armpos = 0.0; armpos >= 0.0; armpos -= .05){ |
cstab94 | 2:f10d71467f13 | 34 | arm = armpos; |
cstab94 | 2:f10d71467f13 | 35 | wait(.1); |
cstab94 | 2:f10d71467f13 | 36 | } |
cstab94 | 2:f10d71467f13 | 37 | } |
cstab94 | 2:f10d71467f13 | 38 | else if(sw2 == 0) |
cstab94 | 2:f10d71467f13 | 39 | { |
cstab94 | 2:f10d71467f13 | 40 | arm = armpos; |
cstab94 | 2:f10d71467f13 | 41 | } |
cstab94 | 2:f10d71467f13 | 42 | } |
cstab94 | 2:f10d71467f13 | 43 | } |