Presentation code for PROJECT #1 - ES200 Fall 2014

Dependencies:   Servo mbed Motor

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?

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