Presentation code for PROJECT #1 - ES200 Fall 2014

Dependencies:   Servo mbed Motor

Committer:
westobrien
Date:
Thu Oct 23 00:05:07 2014 +0000
Revision:
8:30eb49981a91
Parent:
7:39fd13b43380
Child:
9:8682923e9260
cranes for life

Who changed what in which revision?

UserRevisionLine numberNew contents of line
cstab94 0:80cc8025b1c0 1 //MIDN 3/C W. O'Brien, D. Thompson-Sevcik, C. Stabler
cstab94 0:80cc8025b1c0 2 //Candy scooper program for Project #1, ES200 Fall 2014
cstab94 0:80cc8025b1c0 3 //Modifications: 9 OCT- Initial code
cstab94 0:80cc8025b1c0 4
cstab94 0:80cc8025b1c0 5 #include "mbed.h"
cstab94 0:80cc8025b1c0 6 #include "Motor.h"
cstab94 0:80cc8025b1c0 7 #include "Servo.h"
tsevcik08 5:cf58a6bfdd7a 8
tsevcik08 5:cf58a6bfdd7a 9 Motor kate(p26, p29, p30);
cstab94 4:0ed46a6cdf66 10 Servo arm(p21);
tsevcik08 5:cf58a6bfdd7a 11 Servo scoop(p22);
cstab94 4:0ed46a6cdf66 12 DigitalIn sw1(p16); //up
cstab94 4:0ed46a6cdf66 13 DigitalIn sw2(p17); //down
cstab94 4:0ed46a6cdf66 14 DigitalIn sw3(p18); //dump
cstab94 4:0ed46a6cdf66 15 DigitalIn sw4(p19);
cstab94 4:0ed46a6cdf66 16 DigitalIn sw5(p20);
tsevcik08 7:39fd13b43380 17 BusOut w(p5, p6, p7, p8, p11); //data bus for LEDs
cstab94 4:0ed46a6cdf66 18
cstab94 4:0ed46a6cdf66 19
tsevcik08 5:cf58a6bfdd7a 20 int main()
tsevcik08 5:cf58a6bfdd7a 21 {
cstab94 4:0ed46a6cdf66 22
westobrien 8:30eb49981a91 23
tsevcik08 7:39fd13b43380 24
tsevcik08 7:39fd13b43380 25
tsevcik08 7:39fd13b43380 26
cstab94 4:0ed46a6cdf66 27 float armpos;
cstab94 4:0ed46a6cdf66 28 float servopos;
cstab94 4:0ed46a6cdf66 29 float mspeed;
tsevcik08 7:39fd13b43380 30 w = 16;
tsevcik08 5:cf58a6bfdd7a 31 while(1) {
westobrien 8:30eb49981a91 32
tsevcik08 5:cf58a6bfdd7a 33 if( sw4 == 1 && sw5 == 0 && sw1 == 0 && sw2 == 0 ) {
westobrien 8:30eb49981a91 34 mspeed = 0.40;
cstab94 4:0ed46a6cdf66 35 kate.speed(mspeed);
cstab94 4:0ed46a6cdf66 36 wait(.05);
westobrien 8:30eb49981a91 37 mspeed = 0.0;
westobrien 8:30eb49981a91 38 kate.speed(mspeed);
westobrien 8:30eb49981a91 39 wait(.25);
tsevcik08 7:39fd13b43380 40
westobrien 8:30eb49981a91 41 if(w < 1 || w > 16){
westobrien 8:30eb49981a91 42 w=16; }
tsevcik08 7:39fd13b43380 43 w = w/2; //moves LED to the right by changing binary value
tsevcik08 5:cf58a6bfdd7a 44 } else if( sw5 == 1 && sw4 == 0 && sw1 == 0 && sw2 == 0) {
westobrien 8:30eb49981a91 45 mspeed = -0.40;
cstab94 4:0ed46a6cdf66 46 kate.speed(mspeed);
westobrien 8:30eb49981a91 47 wait(.05);
cstab94 4:0ed46a6cdf66 48 mspeed = 0.0;
cstab94 4:0ed46a6cdf66 49 kate.speed(mspeed);
westobrien 8:30eb49981a91 50 wait(.25);
tsevcik08 7:39fd13b43380 51
westobrien 8:30eb49981a91 52 if(w < 1 || w > 16){
tsevcik08 7:39fd13b43380 53 w=1;
westobrien 8:30eb49981a91 54 }
tsevcik08 7:39fd13b43380 55 w = w*2;
tsevcik08 5:cf58a6bfdd7a 56 } else if (sw3 == 1 && sw2 == 0 && sw1 == 0 && sw4 == 0 && sw5 == 0 ) {
tsevcik08 6:18052a74ae56 57 for (servopos = 0; servopos <= 0.5; servopos += 0.5) {
tsevcik08 5:cf58a6bfdd7a 58 scoop = servopos;
tsevcik08 7:39fd13b43380 59 w = 8;
tsevcik08 5:cf58a6bfdd7a 60 }
tsevcik08 5:cf58a6bfdd7a 61 wait (1);
tsevcik08 5:cf58a6bfdd7a 62 } else if(sw1 == 1 && sw2 == 0 && sw5 == 0 && sw4 == 0 ) {
tsevcik08 7:39fd13b43380 63 armpos += .02;
tsevcik08 5:cf58a6bfdd7a 64 arm = armpos;
tsevcik08 5:cf58a6bfdd7a 65 wait(.05);
tsevcik08 7:39fd13b43380 66 w=31;
tsevcik08 7:39fd13b43380 67 wait(.05);
tsevcik08 7:39fd13b43380 68 w= 0;
tsevcik08 5:cf58a6bfdd7a 69 } else if(sw2 == 1 && sw1 == 0 && sw4 == 0 && sw5 == 0) {
westobrien 8:30eb49981a91 70 armpos -= .08;
tsevcik08 5:cf58a6bfdd7a 71 arm = armpos;
tsevcik08 5:cf58a6bfdd7a 72 wait(.05);
tsevcik08 7:39fd13b43380 73 w=3;
tsevcik08 7:39fd13b43380 74 wait(.25);
tsevcik08 7:39fd13b43380 75 w=28;
tsevcik08 5:cf58a6bfdd7a 76 } else if (sw4 == 0 && sw1 == 0 && sw2 == 0 && sw3 == 0 && sw5 == 0) {
cstab94 4:0ed46a6cdf66 77 mspeed = 0.0;
cstab94 4:0ed46a6cdf66 78 kate.speed(mspeed);
tsevcik08 5:cf58a6bfdd7a 79 arm = armpos;
tsevcik08 5:cf58a6bfdd7a 80 wait(.1);
tsevcik08 5:cf58a6bfdd7a 81 for (servopos = 1.0; servopos >= 0; servopos -=1.0) {
tsevcik08 5:cf58a6bfdd7a 82 scoop = servopos;
tsevcik08 5:cf58a6bfdd7a 83 }
cstab94 4:0ed46a6cdf66 84 }
tsevcik08 5:cf58a6bfdd7a 85 }
tsevcik08 5:cf58a6bfdd7a 86
cstab94 4:0ed46a6cdf66 87 }//end main
cstab94 4:0ed46a6cdf66 88