![](/media/cache/group/default_image.jpg.50x50_q85.jpg)
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?
User | Revision | Line number | New 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 |