Collinz is a bo$$_17 / Mbed 2 deprecated projecto0003030020

sunday code for project. needs slight revision.

Dependencies:   Motor Servo22oct mbed

main.cpp@2:c95e4e33eaee, 2014-10-20 (annotated)

Committer:
KyleSchaff
Date:
Mon Oct 20 19:24:49 2014 +0000
Revision:
2:c95e4e33eaee
Parent:
1:33ef833aae0b
Child:
3:b81a3d326aee
dfsgsadfgsdfg

Who changed what in which revision?

UserRevisionLine numberNew contents of line
KyleSchaff 0:db9e971c8ba6 1 #include "mbed.h"
KyleSchaff 0:db9e971c8ba6 2 #include "Servo.h"
KyleSchaff 0:db9e971c8ba6 3 #include "Motor.h"
KyleSchaff 0:db9e971c8ba6 4
KyleSchaff 0:db9e971c8ba6 5 DigitalIn Switch1(p16);
KyleSchaff 0:db9e971c8ba6 6 DigitalIn Switch2(p17);
KyleSchaff 0:db9e971c8ba6 7 DigitalIn Switch3(p18);
KyleSchaff 0:db9e971c8ba6 8 DigitalIn Switch4(p19);
KyleSchaff 0:db9e971c8ba6 9
KyleSchaff 0:db9e971c8ba6 10 BusOut LED(p5,p6,p7,p8,p11);
KyleSchaff 0:db9e971c8ba6 11
KyleSchaff 2:c95e4e33eaee 12 Motor m(p26,p29,p30);
KyleSchaff 2:c95e4e33eaee 13 Servo servo1(p21);
KyleSchaff 2:c95e4e33eaee 14 Servo servo2(p22);
KyleSchaff 0:db9e971c8ba6 15
KyleSchaff 0:db9e971c8ba6 16
KyleSchaff 2:c95e4e33eaee 17 float servopos;
KyleSchaff 2:c95e4e33eaee 18 float motorspeed;
KyleSchaff 0:db9e971c8ba6 19 int counter=0;
KyleSchaff 0:db9e971c8ba6 20 int counter1=0;
KyleSchaff 0:db9e971c8ba6 21
KyleSchaff 0:db9e971c8ba6 22 int main()
KyleSchaff 0:db9e971c8ba6 23 {
KyleSchaff 0:db9e971c8ba6 24 while (1) {
KyleSchaff 2:c95e4e33eaee 25 int sw1=Switch1;
KyleSchaff 2:c95e4e33eaee 26 int sw2=Switch2;
KyleSchaff 2:c95e4e33eaee 27 int sw3=Switch3;
KyleSchaff 2:c95e4e33eaee 28 int sw4=Switch4;
KyleSchaff 2:c95e4e33eaee 29
KyleSchaff 0:db9e971c8ba6 30 while (sw1==1) {
KyleSchaff 2:c95e4e33eaee 31 m.speed(motorspeed);
KyleSchaff 2:c95e4e33eaee 32 motorspeed=.35;
KyleSchaff 2:c95e4e33eaee 33 for(servopos=.48; servopos<=.68; servopos+=.005) {
KyleSchaff 2:c95e4e33eaee 34 servo1=servopos+.07;
KyleSchaff 0:db9e971c8ba6 35 servo2=servopos;
KyleSchaff 0:db9e971c8ba6 36 counter=counter+1;
KyleSchaff 0:db9e971c8ba6 37 counter1=counter%20;
KyleSchaff 0:db9e971c8ba6 38 if (counter1==17) {
KyleSchaff 0:db9e971c8ba6 39 LED=rand()%129;
KyleSchaff 0:db9e971c8ba6 40 }
KyleSchaff 1:33ef833aae0b 41 wait (.01);
KyleSchaff 0:db9e971c8ba6 42 }
KyleSchaff 2:c95e4e33eaee 43 for(servopos=.68; servopos>=.48; servopos-=.005) {
KyleSchaff 2:c95e4e33eaee 44 servo1=servopos+.07;
KyleSchaff 1:33ef833aae0b 45 servo2=servopos;
KyleSchaff 1:33ef833aae0b 46 counter=counter+1;
KyleSchaff 1:33ef833aae0b 47 counter1=counter%20;
KyleSchaff 1:33ef833aae0b 48 if (counter1==17) {
KyleSchaff 1:33ef833aae0b 49 LED=rand()%129;
KyleSchaff 1:33ef833aae0b 50 }
KyleSchaff 1:33ef833aae0b 51 wait (.01);
KyleSchaff 1:33ef833aae0b 52 }
KyleSchaff 0:db9e971c8ba6 53 }
KyleSchaff 0:db9e971c8ba6 54 while(sw2==1) {
KyleSchaff 2:c95e4e33eaee 55 m.speed(motorspeed);
KyleSchaff 2:c95e4e33eaee 56 motorspeed=.41;
KyleSchaff 2:c95e4e33eaee 57 for(servopos=.48; servopos<=.68; servopos+=.005) {
KyleSchaff 2:c95e4e33eaee 58 servo1=servopos+.07;
KyleSchaff 0:db9e971c8ba6 59 servo2=servopos;
KyleSchaff 0:db9e971c8ba6 60 counter=counter+1;
KyleSchaff 0:db9e971c8ba6 61 counter1=counter%20;
KyleSchaff 0:db9e971c8ba6 62 if (counter1==17) {
KyleSchaff 0:db9e971c8ba6 63 LED=rand()%129;
KyleSchaff 0:db9e971c8ba6 64 }
KyleSchaff 2:c95e4e33eaee 65 wait (.009);
KyleSchaff 0:db9e971c8ba6 66 }
KyleSchaff 2:c95e4e33eaee 67 for(servopos=.68; servopos>=.48; servopos-=.005) {
KyleSchaff 2:c95e4e33eaee 68 servo1=servopos+.07;
KyleSchaff 1:33ef833aae0b 69 servo2=servopos;
KyleSchaff 1:33ef833aae0b 70 counter=counter+1;
KyleSchaff 1:33ef833aae0b 71 counter1=counter%20;
KyleSchaff 1:33ef833aae0b 72 if (counter1==17) {
KyleSchaff 1:33ef833aae0b 73 LED=rand()%129;
KyleSchaff 1:33ef833aae0b 74 }
KyleSchaff 2:c95e4e33eaee 75 wait (.009);
KyleSchaff 1:33ef833aae0b 76 }
KyleSchaff 0:db9e971c8ba6 77 }
KyleSchaff 0:db9e971c8ba6 78 while(sw3==1) {
KyleSchaff 2:c95e4e33eaee 79 m.speed(motorspeed);
KyleSchaff 2:c95e4e33eaee 80 motorspeed=.47;
KyleSchaff 2:c95e4e33eaee 81 for(servopos=.48; servopos<=.68; servopos+=.005) {
KyleSchaff 2:c95e4e33eaee 82 servo1=servopos+.07;
KyleSchaff 0:db9e971c8ba6 83 servo2=servopos;
KyleSchaff 0:db9e971c8ba6 84 counter=counter+1;
KyleSchaff 0:db9e971c8ba6 85 counter1=counter%20;
KyleSchaff 0:db9e971c8ba6 86 if (counter1==17) {
KyleSchaff 0:db9e971c8ba6 87 LED=rand()%129;
KyleSchaff 0:db9e971c8ba6 88 }
KyleSchaff 2:c95e4e33eaee 89 wait (.008);
KyleSchaff 0:db9e971c8ba6 90 }
KyleSchaff 2:c95e4e33eaee 91 for(servopos=.68; servopos>=.48; servopos-=.005) {
KyleSchaff 2:c95e4e33eaee 92 servo1=servopos+.07;
KyleSchaff 1:33ef833aae0b 93 servo2=servopos;
KyleSchaff 1:33ef833aae0b 94 counter=counter+1;
KyleSchaff 1:33ef833aae0b 95 counter1=counter%20;
KyleSchaff 1:33ef833aae0b 96 if (counter1==17) {
KyleSchaff 1:33ef833aae0b 97 LED=rand()%129;
KyleSchaff 1:33ef833aae0b 98 }
KyleSchaff 2:c95e4e33eaee 99 wait (.008);
KyleSchaff 1:33ef833aae0b 100 }
KyleSchaff 0:db9e971c8ba6 101 }
KyleSchaff 0:db9e971c8ba6 102 while(sw4==1) {
KyleSchaff 2:c95e4e33eaee 103 m.speed(motorspeed);
KyleSchaff 2:c95e4e33eaee 104 motorspeed=.77;
KyleSchaff 2:c95e4e33eaee 105 for(servopos=.48; servopos<=.68; servopos+=.005) {
KyleSchaff 2:c95e4e33eaee 106 servo1=servopos+.07;
KyleSchaff 0:db9e971c8ba6 107 servo2=servopos;
KyleSchaff 0:db9e971c8ba6 108 counter=counter+1;
KyleSchaff 0:db9e971c8ba6 109 counter1=counter%20;
KyleSchaff 0:db9e971c8ba6 110 if (counter1==17) {
KyleSchaff 0:db9e971c8ba6 111 LED=rand()%129;
KyleSchaff 0:db9e971c8ba6 112 }
KyleSchaff 2:c95e4e33eaee 113 wait (.005);
KyleSchaff 0:db9e971c8ba6 114 }
KyleSchaff 2:c95e4e33eaee 115 for(servopos=.68; servopos>=.48; servopos-=.005) {
KyleSchaff 2:c95e4e33eaee 116 servo1=servopos+.07;
KyleSchaff 0:db9e971c8ba6 117 servo2=servopos;
KyleSchaff 0:db9e971c8ba6 118 counter=counter+1;
KyleSchaff 0:db9e971c8ba6 119 counter1=counter%20;
KyleSchaff 0:db9e971c8ba6 120 if (counter1==17) {
KyleSchaff 0:db9e971c8ba6 121 LED=rand()%129;
KyleSchaff 0:db9e971c8ba6 122 }
KyleSchaff 2:c95e4e33eaee 123 wait (.005);
KyleSchaff 0:db9e971c8ba6 124 }
KyleSchaff 0:db9e971c8ba6 125 }
KyleSchaff 0:db9e971c8ba6 126
KyleSchaff 0:db9e971c8ba6 127 }
KyleSchaff 0:db9e971c8ba6 128 }