Tyfighters / Mbed 2 deprecated launch_servo

this isn't working the servo just twitches

Dependencies:   Servo mbed Motor

main.cpp@2:c754297f78ff, 2014-10-23 (annotated)

Committer:
Ty
Date:
Thu Oct 23 12:31:39 2014 +0000
Revision:
2:c754297f78ff
Parent:
1:7fa77283f89e 
This is the final one boys

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Ty 2:c754297f78ff 1 // Ty LaFramboise, Jin Soo Park, Kevin Saxton
Ty 2:c754297f78ff 2 //Project 1
Ty 2:c754297f78ff 3 //Professor Piepmeier
Ty 2:c754297f78ff 4
Ty 2:c754297f78ff 5
Ty 0:22157cad3c1e 6 #include "mbed.h"
Ty 0:22157cad3c1e 7 #include "Servo.h"
Ty 2:c754297f78ff 8 #include "Motor.h"
Ty 2:c754297f78ff 9 DigitalIn sw1(p16);
Ty 2:c754297f78ff 10 Motor m(p26,p29,p30);
Ty 2:c754297f78ff 11 float motspeed=.4;
Ty 2:c754297f78ff 12 int count = 0;
Ty 2:c754297f78ff 13 int count2 = 0;
Ty 0:22157cad3c1e 14 Servo launchservo(p21);
Ty 1:7fa77283f89e 15 BusOut lights(p5, p6, p7, p8);
Ty 1:7fa77283f89e 16 DigitalIn sw4(p19);
Ty 2:c754297f78ff 17 Servo myservo1(p22); //inititalize motors and servo
Ty 2:c754297f78ff 18 DigitalIn sw2(p17);
Ty 2:c754297f78ff 19 DigitalIn sw3(p18);
Ty 2:c754297f78ff 20 float servopos; //current position of servos
Ty 2:c754297f78ff 21 float waittime=0.02;
Ty 0:22157cad3c1e 22 int launchswitch;
Ty 1:7fa77283f89e 23 int main()
Ty 1:7fa77283f89e 24 {
Ty 1:7fa77283f89e 25 float i;
Ty 0:22157cad3c1e 26 launchservo=0;
Ty 1:7fa77283f89e 27 while(1) {
Ty 2:c754297f78ff 28 //DC Motor
Ty 2:c754297f78ff 29 while (count < 5 && sw1 !=0) {//DC Motor gets power to turn counter clockwise
Ty 2:c754297f78ff 30 m.speed(motspeed);
Ty 2:c754297f78ff 31 wait(.08);
Ty 2:c754297f78ff 32 m.speed(0.0);
Ty 2:c754297f78ff 33 wait(.3);
Ty 2:c754297f78ff 34 count ++;
Ty 2:c754297f78ff 35 }
Ty 2:c754297f78ff 36 while (count2 < 5 && sw1 !=0) {//DC Motor gets power to turn clockwise
Ty 2:c754297f78ff 37 m.speed(-motspeed);
Ty 2:c754297f78ff 38 wait(.08);
Ty 2:c754297f78ff 39 m.speed(0.0);
Ty 2:c754297f78ff 40 wait(.3);
Ty 2:c754297f78ff 41 count2 ++;
Ty 2:c754297f78ff 42
Ty 2:c754297f78ff 43 }
Ty 2:c754297f78ff 44 count=0;
Ty 2:c754297f78ff 45 count2=0;
Ty 2:c754297f78ff 46 if(sw1==0) {
Ty 2:c754297f78ff 47
Ty 2:c754297f78ff 48 }
Ty 2:c754297f78ff 49 // riser servo
Ty 2:c754297f78ff 50 if(sw2==1) {
Ty 2:c754297f78ff 51 servopos=0.5;
Ty 2:c754297f78ff 52 while(sw2==1) {
Ty 2:c754297f78ff 53 servopos+=0.0025;
Ty 2:c754297f78ff 54 wait(waittime);
Ty 2:c754297f78ff 55 myservo1=servopos;
Ty 2:c754297f78ff 56
Ty 2:c754297f78ff 57 }
Ty 2:c754297f78ff 58 }
Ty 2:c754297f78ff 59 if(sw3==1) {
Ty 2:c754297f78ff 60 servopos=myservo1;
Ty 2:c754297f78ff 61
Ty 2:c754297f78ff 62 while(sw3==1) {
Ty 2:c754297f78ff 63 servopos-=0.0025;
Ty 2:c754297f78ff 64 wait(waittime);
Ty 2:c754297f78ff 65 myservo1=servopos;
Ty 2:c754297f78ff 66 }
Ty 2:c754297f78ff 67 }
Ty 2:c754297f78ff 68 //launch servo
Ty 1:7fa77283f89e 69 if(sw4) {
Ty 2:c754297f78ff 70 lights=15;// LED light countdown
Ty 1:7fa77283f89e 71 wait(.5);
Ty 1:7fa77283f89e 72 lights=14;
Ty 1:7fa77283f89e 73 wait(.5);
Ty 1:7fa77283f89e 74 lights=12;
Ty 1:7fa77283f89e 75 wait(.5);
Ty 1:7fa77283f89e 76 lights=8;
Ty 1:7fa77283f89e 77 wait(.5);
Ty 1:7fa77283f89e 78 lights=0;
Ty 1:7fa77283f89e 79 wait(.5);
Ty 1:7fa77283f89e 80 printf("a\n");
Ty 1:7fa77283f89e 81 for (i=0; i<=1.0; i+=.01) {
Ty 2:c754297f78ff 82 launchservo=i;//Turns the servo releasing the plane
Ty 1:7fa77283f89e 83 printf("b\n");
Ty 1:7fa77283f89e 84 wait(.01);
Ty 2:c754297f78ff 85
Ty 1:7fa77283f89e 86
Ty 1:7fa77283f89e 87 }
Ty 1:7fa77283f89e 88
Ty 1:7fa77283f89e 89 }
Ty 1:7fa77283f89e 90
Ty 0:22157cad3c1e 91 }
Ty 1:7fa77283f89e 92 }
Ty 2:c754297f78ff 93
Ty 2:c754297f78ff 94
Ty 2:c754297f78ff 95
Ty 2:c754297f78ff 96
Ty 2:c754297f78ff 97
Ty 2:c754297f78ff 98
Ty 2:c754297f78ff 99
Ty 2:c754297f78ff 100
Ty 2:c754297f78ff 101
Ty 2:c754297f78ff 102
Ty 2:c754297f78ff 103
Ty 2:c754297f78ff 104
Ty 2:c754297f78ff 105
Ty 2:c754297f78ff 106
Ty 2:c754297f78ff 107
Ty 2:c754297f78ff 108
Ty 2:c754297f78ff 109
Ty 2:c754297f78ff 110
Ty 2:c754297f78ff 111
Ty 2:c754297f78ff 112