![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
Project for 380
main.cpp@0:110dc3bbf9c1, 2019-09-27 (annotated)
- Committer:
- b28nguye
- Date:
- Fri Sep 27 15:21:03 2019 +0000
- Revision:
- 0:110dc3bbf9c1
- Child:
- 1:679934743c5e
sure;
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
b28nguye | 0:110dc3bbf9c1 | 1 | // Continuously sweep the servo through it's full range |
b28nguye | 0:110dc3bbf9c1 | 2 | #include "mbed.h" |
b28nguye | 0:110dc3bbf9c1 | 3 | #include "Servo.h" |
b28nguye | 0:110dc3bbf9c1 | 4 | |
b28nguye | 0:110dc3bbf9c1 | 5 | Servo servo_1(D3); |
b28nguye | 0:110dc3bbf9c1 | 6 | Servo servo_2(D5); |
b28nguye | 0:110dc3bbf9c1 | 7 | Servo servo_3(D6); |
b28nguye | 0:110dc3bbf9c1 | 8 | Servo servo_4(D9); |
b28nguye | 0:110dc3bbf9c1 | 9 | Servo servo_5(D10); |
b28nguye | 0:110dc3bbf9c1 | 10 | Servo servo_6(D11); |
b28nguye | 0:110dc3bbf9c1 | 11 | |
b28nguye | 0:110dc3bbf9c1 | 12 | |
b28nguye | 0:110dc3bbf9c1 | 13 | void test_write(Servo servo_ID){ |
b28nguye | 0:110dc3bbf9c1 | 14 | while(1) { |
b28nguye | 0:110dc3bbf9c1 | 15 | wait(1.0); |
b28nguye | 0:110dc3bbf9c1 | 16 | |
b28nguye | 0:110dc3bbf9c1 | 17 | for(int i=0; i<100; i++) { //adjust range |
b28nguye | 0:110dc3bbf9c1 | 18 | servo_ID = i/100.0; //adjust speed |
b28nguye | 0:110dc3bbf9c1 | 19 | wait(0.01); |
b28nguye | 0:110dc3bbf9c1 | 20 | } |
b28nguye | 0:110dc3bbf9c1 | 21 | wait(1.0); |
b28nguye | 0:110dc3bbf9c1 | 22 | |
b28nguye | 0:110dc3bbf9c1 | 23 | for(int i=100; i>0; i--) { |
b28nguye | 0:110dc3bbf9c1 | 24 | servo_ID = i/100.0; |
b28nguye | 0:110dc3bbf9c1 | 25 | wait(0.01); |
b28nguye | 0:110dc3bbf9c1 | 26 | } |
b28nguye | 0:110dc3bbf9c1 | 27 | } |
b28nguye | 0:110dc3bbf9c1 | 28 | } |
b28nguye | 0:110dc3bbf9c1 | 29 | |
b28nguye | 0:110dc3bbf9c1 | 30 | void test_position(Servo servo_ID){ |
b28nguye | 0:110dc3bbf9c1 | 31 | int y =0; |
b28nguye | 0:110dc3bbf9c1 | 32 | while(1){ |
b28nguye | 0:110dc3bbf9c1 | 33 | y +=1; |
b28nguye | 0:110dc3bbf9c1 | 34 | printf("Test %d ", y); |
b28nguye | 0:110dc3bbf9c1 | 35 | for (int i=-90; i<=90; i+=45){ |
b28nguye | 0:110dc3bbf9c1 | 36 | servo_ID.position(i); |
b28nguye | 0:110dc3bbf9c1 | 37 | servo_2.position(i); |
b28nguye | 0:110dc3bbf9c1 | 38 | //servo_3.position(i); |
b28nguye | 0:110dc3bbf9c1 | 39 | wait(1); |
b28nguye | 0:110dc3bbf9c1 | 40 | //printf("Angle %d", i); |
b28nguye | 0:110dc3bbf9c1 | 41 | //wait(1); |
b28nguye | 0:110dc3bbf9c1 | 42 | } |
b28nguye | 0:110dc3bbf9c1 | 43 | } |
b28nguye | 0:110dc3bbf9c1 | 44 | } |
b28nguye | 0:110dc3bbf9c1 | 45 | |
b28nguye | 0:110dc3bbf9c1 | 46 | int main() { |
b28nguye | 0:110dc3bbf9c1 | 47 | printf ("test start"); |
b28nguye | 0:110dc3bbf9c1 | 48 | wait(1.0); |
b28nguye | 0:110dc3bbf9c1 | 49 | //test_write(servo_1); |
b28nguye | 0:110dc3bbf9c1 | 50 | test_position(servo_1); |
b28nguye | 0:110dc3bbf9c1 | 51 | int x = 0; |
b28nguye | 0:110dc3bbf9c1 | 52 | while (1){ |
b28nguye | 0:110dc3bbf9c1 | 53 | printf ("Test %d ", x); |
b28nguye | 0:110dc3bbf9c1 | 54 | x +=1; |
b28nguye | 0:110dc3bbf9c1 | 55 | } |
b28nguye | 0:110dc3bbf9c1 | 56 | } |