sunday code for project. needs slight revision.
Dependencies: Motor Servo22oct mbed
main.cpp
- Committer:
- KyleSchaff
- Date:
- 2014-10-19
- Revision:
- 0:db9e971c8ba6
- Child:
- 1:33ef833aae0b
File content as of revision 0:db9e971c8ba6:
#include "mbed.h" #include "Servo.h" #include "Motor.h" DigitalIn Switch1(p16); DigitalIn Switch2(p17); DigitalIn Switch3(p18); DigitalIn Switch4(p19); BusOut LED(p5,p6,p7,p8,p11); DigitalOut servo1(p21); DigitalOut servo2(p22); DigitalOut motor(p29); //Don't know if this is correct int sw1=Switch1; int sw2=Switch2; int sw3=Switch3; int sw4=Switch4; int servopos; int servoposition; int motorspeed=motor; int counter=0; int counter1=0; int main() { while (1) { while (sw1==1) { for(servopos=.38; servopos<=.51; servopos+=.001) { servo1=servopos; servo2=servopos; motorspeed=.35; counter=counter+1; counter1=counter%20; if (counter1==17) { LED=rand()%129; } wait (.005); } for(servopos=.51; servopos<=.38; servopos+=.001) { servo1=servopos; servo2=servopos; motorspeed=.35; counter=counter+1; counter1=counter%20; if (counter1==17) { LED=rand()%129; } wait (.005); } } while(sw2==1) { for(servopos=.38; servopos<=.51; servopos+=.001) { servo1=servopos; servo2=servopos; motorspeed=.41; counter=counter+1; counter1=counter%20; if (counter1==17) { LED=rand()%129; } wait (.003); } for(servopos=.51; servopos<=.38; servopos+=.001) { servo1=servopos; servo2=servopos; motorspeed=.41; counter=counter+1; counter1=counter%20; if (counter1==17) { LED=rand()%129; } wait (.003); } } while(sw3==1) { for(servopos=.38; servopos<=.51; servopos+=.001) { servo1=servopos; servo2=servopos; motorspeed=.47; counter=counter+1; counter1=counter%20; if (counter1==17) { LED=rand()%129; } wait (.002); } for(servopos=.51; servopos<=.38; servopos+=.001) { servo1=servopos; servo2=servopos; motorspeed=.47; counter=counter+1; counter1=counter%20; if (counter1==17) { LED=rand()%129; } wait (.002); } } while(sw4==1) { for(servopos=.38; servopos<=.51; servopos+=.001) { servo1=servopos; servo2=servopos; motorspeed=.77; counter=counter+1; counter1=counter%20; if (counter1==17) { LED=rand()%129; } wait (.001); } for(servopos=.51; servopos<=.38; servopos+=.001) { servo1=servopos; servo2=servopos; motorspeed=.77; counter=counter+1; counter1=counter%20; if (counter1==17) { LED=rand()%129; } wait (.001); } } } }