Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
Dependencies: Motor Servo22oct mbed
Fork of projecto0003030020 by
main.cpp@3:b81a3d326aee, 2014-10-22 (annotated)
- Committer:
- jkangwi
- Date:
- Wed Oct 22 02:06:11 2014 +0000
- Revision:
- 3:b81a3d326aee
- Parent:
- 2:c95e4e33eaee
- Child:
- 4:4b093f9bd41c
Gabe and Jordan
Who changed what in which revision?
| User | Revision | Line number | New 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 | |
| jkangwi | 3:b81a3d326aee | 5 | //DigitalIn Switch1(p16); |
| jkangwi | 3:b81a3d326aee | 6 | //DigitalIn Switch2(p17); |
| jkangwi | 3:b81a3d326aee | 7 | //DigitalIn Switch3(p18); |
| jkangwi | 3:b81a3d326aee | 8 | //DigitalIn Switch4(p19); |
| KyleSchaff | 0:db9e971c8ba6 | 9 | |
| jkangwi | 3:b81a3d326aee | 10 | BusIn Switch(p16,p17,p18,p19); |
| KyleSchaff | 0:db9e971c8ba6 | 11 | BusOut LED(p5,p6,p7,p8,p11); |
| KyleSchaff | 0:db9e971c8ba6 | 12 | |
| KyleSchaff | 2:c95e4e33eaee | 13 | Motor m(p26,p29,p30); |
| jkangwi | 3:b81a3d326aee | 14 | Servo servo1(p21); //top .39 to 1.02 |
| jkangwi | 3:b81a3d326aee | 15 | Servo servo2(p22); //bottom .38 to .93 |
| KyleSchaff | 0:db9e971c8ba6 | 16 | |
| KyleSchaff | 0:db9e971c8ba6 | 17 | |
| KyleSchaff | 2:c95e4e33eaee | 18 | float servopos; |
| KyleSchaff | 2:c95e4e33eaee | 19 | float motorspeed; |
| KyleSchaff | 0:db9e971c8ba6 | 20 | int counter=0; |
| KyleSchaff | 0:db9e971c8ba6 | 21 | int counter1=0; |
| KyleSchaff | 0:db9e971c8ba6 | 22 | |
| jkangwi | 3:b81a3d326aee | 23 | //float sw1=Switch1; |
| jkangwi | 3:b81a3d326aee | 24 | //float sw2=Switch2; |
| jkangwi | 3:b81a3d326aee | 25 | //float sw3=Switch3; |
| jkangwi | 3:b81a3d326aee | 26 | //float sw4=Switch4; |
| jkangwi | 3:b81a3d326aee | 27 | |
| KyleSchaff | 0:db9e971c8ba6 | 28 | int main() |
| KyleSchaff | 0:db9e971c8ba6 | 29 | { |
| jkangwi | 3:b81a3d326aee | 30 | while(1) { |
| jkangwi | 3:b81a3d326aee | 31 | |
| jkangwi | 3:b81a3d326aee | 32 | |
| jkangwi | 3:b81a3d326aee | 33 | while (Switch==1) { |
| jkangwi | 3:b81a3d326aee | 34 | |
| jkangwi | 3:b81a3d326aee | 35 | |
| jkangwi | 3:b81a3d326aee | 36 | for(servopos=.50; servopos<=.65; servopos+=.03) { |
| jkangwi | 3:b81a3d326aee | 37 | servo1=.77; |
| KyleSchaff | 0:db9e971c8ba6 | 38 | servo2=servopos; |
| jkangwi | 3:b81a3d326aee | 39 | |
| KyleSchaff | 0:db9e971c8ba6 | 40 | counter=counter+1; |
| KyleSchaff | 0:db9e971c8ba6 | 41 | counter1=counter%20; |
| KyleSchaff | 0:db9e971c8ba6 | 42 | if (counter1==17) { |
| KyleSchaff | 0:db9e971c8ba6 | 43 | LED=rand()%129; |
| KyleSchaff | 0:db9e971c8ba6 | 44 | } |
| jkangwi | 3:b81a3d326aee | 45 | wait (.1); |
| KyleSchaff | 0:db9e971c8ba6 | 46 | } |
| jkangwi | 3:b81a3d326aee | 47 | for(servopos=.50; servopos>=.45; servopos-=.03) { |
| jkangwi | 3:b81a3d326aee | 48 | servo1=.77; |
| KyleSchaff | 1:33ef833aae0b | 49 | servo2=servopos; |
| jkangwi | 3:b81a3d326aee | 50 | |
| KyleSchaff | 1:33ef833aae0b | 51 | counter=counter+1; |
| KyleSchaff | 1:33ef833aae0b | 52 | counter1=counter%20; |
| KyleSchaff | 1:33ef833aae0b | 53 | if (counter1==17) { |
| KyleSchaff | 1:33ef833aae0b | 54 | LED=rand()%129; |
| KyleSchaff | 1:33ef833aae0b | 55 | } |
| jkangwi | 3:b81a3d326aee | 56 | wait (.1); |
| KyleSchaff | 1:33ef833aae0b | 57 | } |
| KyleSchaff | 0:db9e971c8ba6 | 58 | } |
| jkangwi | 3:b81a3d326aee | 59 | while(Switch==2) { |
| jkangwi | 3:b81a3d326aee | 60 | |
| jkangwi | 3:b81a3d326aee | 61 | |
| jkangwi | 3:b81a3d326aee | 62 | for(servopos=.38; servopos<=.72; servopos+=.03) { |
| jkangwi | 3:b81a3d326aee | 63 | servo1=servopos+.5; |
| jkangwi | 3:b81a3d326aee | 64 | servo2=.52; |
| jkangwi | 3:b81a3d326aee | 65 | |
| KyleSchaff | 0:db9e971c8ba6 | 66 | counter=counter+1; |
| KyleSchaff | 0:db9e971c8ba6 | 67 | counter1=counter%20; |
| KyleSchaff | 0:db9e971c8ba6 | 68 | if (counter1==17) { |
| KyleSchaff | 0:db9e971c8ba6 | 69 | LED=rand()%129; |
| KyleSchaff | 0:db9e971c8ba6 | 70 | } |
| jkangwi | 3:b81a3d326aee | 71 | wait (.03); |
| KyleSchaff | 0:db9e971c8ba6 | 72 | } |
| jkangwi | 3:b81a3d326aee | 73 | for(servopos=.72; servopos>=.38; servopos-=.03) { |
| jkangwi | 3:b81a3d326aee | 74 | servo1=servopos+.5; |
| jkangwi | 3:b81a3d326aee | 75 | servo2=.52; |
| jkangwi | 3:b81a3d326aee | 76 | |
| KyleSchaff | 1:33ef833aae0b | 77 | counter=counter+1; |
| KyleSchaff | 1:33ef833aae0b | 78 | counter1=counter%20; |
| KyleSchaff | 1:33ef833aae0b | 79 | if (counter1==17) { |
| KyleSchaff | 1:33ef833aae0b | 80 | LED=rand()%129; |
| KyleSchaff | 1:33ef833aae0b | 81 | } |
| jkangwi | 3:b81a3d326aee | 82 | wait (.03); |
| KyleSchaff | 1:33ef833aae0b | 83 | } |
| KyleSchaff | 0:db9e971c8ba6 | 84 | } |
| jkangwi | 3:b81a3d326aee | 85 | while(Switch==4) { |
| jkangwi | 3:b81a3d326aee | 86 | |
| jkangwi | 3:b81a3d326aee | 87 | |
| jkangwi | 3:b81a3d326aee | 88 | for(servopos=.38; servopos<=.74; servopos+=.03) { |
| jkangwi | 3:b81a3d326aee | 89 | servo1=servopos+.5; |
| KyleSchaff | 0:db9e971c8ba6 | 90 | servo2=servopos; |
| jkangwi | 3:b81a3d326aee | 91 | |
| KyleSchaff | 0:db9e971c8ba6 | 92 | counter=counter+1; |
| KyleSchaff | 0:db9e971c8ba6 | 93 | counter1=counter%20; |
| KyleSchaff | 0:db9e971c8ba6 | 94 | if (counter1==17) { |
| KyleSchaff | 0:db9e971c8ba6 | 95 | LED=rand()%129; |
| KyleSchaff | 0:db9e971c8ba6 | 96 | } |
| jkangwi | 3:b81a3d326aee | 97 | wait (.025); |
| KyleSchaff | 0:db9e971c8ba6 | 98 | } |
| jkangwi | 3:b81a3d326aee | 99 | for(servopos=.74; servopos>=.38; servopos-=.03) { |
| jkangwi | 3:b81a3d326aee | 100 | servo1=servopos+.5; |
| KyleSchaff | 1:33ef833aae0b | 101 | servo2=servopos; |
| jkangwi | 3:b81a3d326aee | 102 | |
| KyleSchaff | 1:33ef833aae0b | 103 | counter=counter+1; |
| KyleSchaff | 1:33ef833aae0b | 104 | counter1=counter%20; |
| KyleSchaff | 1:33ef833aae0b | 105 | if (counter1==17) { |
| KyleSchaff | 1:33ef833aae0b | 106 | LED=rand()%129; |
| KyleSchaff | 1:33ef833aae0b | 107 | } |
| jkangwi | 3:b81a3d326aee | 108 | wait (.025); |
| KyleSchaff | 1:33ef833aae0b | 109 | } |
| KyleSchaff | 0:db9e971c8ba6 | 110 | } |
| jkangwi | 3:b81a3d326aee | 111 | while(Switch==8) { |
| KyleSchaff | 2:c95e4e33eaee | 112 | m.speed(motorspeed); |
| jkangwi | 3:b81a3d326aee | 113 | |
| jkangwi | 3:b81a3d326aee | 114 | for(servopos=.38; servopos<=.80; servopos+=.03) { |
| jkangwi | 3:b81a3d326aee | 115 | servo1=servopos+.21; |
| KyleSchaff | 0:db9e971c8ba6 | 116 | servo2=servopos; |
| jkangwi | 3:b81a3d326aee | 117 | motorspeed=.10; |
| 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 | } |
| jkangwi | 3:b81a3d326aee | 123 | wait (.02); |
| KyleSchaff | 0:db9e971c8ba6 | 124 | } |
| jkangwi | 3:b81a3d326aee | 125 | for(servopos=.80; servopos>=.38; servopos-=.03) { |
| jkangwi | 3:b81a3d326aee | 126 | servo1=servopos-.5; |
| KyleSchaff | 0:db9e971c8ba6 | 127 | servo2=servopos; |
| jkangwi | 3:b81a3d326aee | 128 | motorspeed=.10; |
| KyleSchaff | 0:db9e971c8ba6 | 129 | counter=counter+1; |
| KyleSchaff | 0:db9e971c8ba6 | 130 | counter1=counter%20; |
| KyleSchaff | 0:db9e971c8ba6 | 131 | if (counter1==17) { |
| KyleSchaff | 0:db9e971c8ba6 | 132 | LED=rand()%129; |
| KyleSchaff | 0:db9e971c8ba6 | 133 | } |
| jkangwi | 3:b81a3d326aee | 134 | wait (.02); |
| KyleSchaff | 0:db9e971c8ba6 | 135 | } |
| jkangwi | 3:b81a3d326aee | 136 | |
| KyleSchaff | 0:db9e971c8ba6 | 137 | } |
| KyleSchaff | 0:db9e971c8ba6 | 138 | } |
| KyleSchaff | 0:db9e971c8ba6 | 139 | } |
