Board Garudago >> Motor6 --> 1 || Motor2 --> 2 key board: A S --> control pwm1 K L --> control pwm2
Board Garudago (Motor6 ==> 1 || Motor2 ==> 2)
key board
- A S : control pwm1
- K L : control pwm2
main.cpp@0:266cc01fc2c3, 2016-11-10 (annotated)
- Committer:
- Fathoni17
- Date:
- Thu Nov 10 13:19:25 2016 +0000
- Revision:
- 0:266cc01fc2c3
Board Garudago (Motor6 --> 1 || Motor2 --> 2); key board A --> pwm1++; S --> pwm1--;; key board K --> pwm2++; L --> pwm2--;;
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
Fathoni17 | 0:266cc01fc2c3 | 1 | // Library |
Fathoni17 | 0:266cc01fc2c3 | 2 | #include "mbed.h" |
Fathoni17 | 0:266cc01fc2c3 | 3 | #include "Motor.h" |
Fathoni17 | 0:266cc01fc2c3 | 4 | |
Fathoni17 | 0:266cc01fc2c3 | 5 | // Deklarasi pin |
Fathoni17 | 0:266cc01fc2c3 | 6 | Motor motor1 (PB_9, PA_12, PC_5); |
Fathoni17 | 0:266cc01fc2c3 | 7 | Motor motor2 (PA_11, PA_6, PC_6); |
Fathoni17 | 0:266cc01fc2c3 | 8 | |
Fathoni17 | 0:266cc01fc2c3 | 9 | int main (void){ |
Fathoni17 | 0:266cc01fc2c3 | 10 | Serial pc(USBTX,USBRX); |
Fathoni17 | 0:266cc01fc2c3 | 11 | pc.baud(9600); |
Fathoni17 | 0:266cc01fc2c3 | 12 | pc.readable(); |
Fathoni17 | 0:266cc01fc2c3 | 13 | float pwm1=0.1; |
Fathoni17 | 0:266cc01fc2c3 | 14 | float pwm2=0.1; |
Fathoni17 | 0:266cc01fc2c3 | 15 | |
Fathoni17 | 0:266cc01fc2c3 | 16 | while(1){ |
Fathoni17 | 0:266cc01fc2c3 | 17 | char val = pc.getc(); |
Fathoni17 | 0:266cc01fc2c3 | 18 | switch (val) { |
Fathoni17 | 0:266cc01fc2c3 | 19 | case 'a' :{ |
Fathoni17 | 0:266cc01fc2c3 | 20 | pwm1 = pwm1+0.05; |
Fathoni17 | 0:266cc01fc2c3 | 21 | } |
Fathoni17 | 0:266cc01fc2c3 | 22 | break; |
Fathoni17 | 0:266cc01fc2c3 | 23 | case 's' :{ |
Fathoni17 | 0:266cc01fc2c3 | 24 | pwm1 = pwm1-0.05; |
Fathoni17 | 0:266cc01fc2c3 | 25 | } |
Fathoni17 | 0:266cc01fc2c3 | 26 | break; |
Fathoni17 | 0:266cc01fc2c3 | 27 | case 'k' :{ |
Fathoni17 | 0:266cc01fc2c3 | 28 | pwm2 = pwm2+0.05; |
Fathoni17 | 0:266cc01fc2c3 | 29 | } |
Fathoni17 | 0:266cc01fc2c3 | 30 | break; |
Fathoni17 | 0:266cc01fc2c3 | 31 | case 'l' :{ |
Fathoni17 | 0:266cc01fc2c3 | 32 | pwm2 = pwm2-0.05; |
Fathoni17 | 0:266cc01fc2c3 | 33 | } |
Fathoni17 | 0:266cc01fc2c3 | 34 | break; |
Fathoni17 | 0:266cc01fc2c3 | 35 | } |
Fathoni17 | 0:266cc01fc2c3 | 36 | if (pwm1 <= 0.1){ |
Fathoni17 | 0:266cc01fc2c3 | 37 | pwm1 = 0.1; |
Fathoni17 | 0:266cc01fc2c3 | 38 | } |
Fathoni17 | 0:266cc01fc2c3 | 39 | if (pwm2 <= 0.1){ |
Fathoni17 | 0:266cc01fc2c3 | 40 | pwm2 = 0.1; |
Fathoni17 | 0:266cc01fc2c3 | 41 | } |
Fathoni17 | 0:266cc01fc2c3 | 42 | |
Fathoni17 | 0:266cc01fc2c3 | 43 | motor1.speed(pwm1); |
Fathoni17 | 0:266cc01fc2c3 | 44 | motor2.speed(pwm2); |
Fathoni17 | 0:266cc01fc2c3 | 45 | wait_ms(5); |
Fathoni17 | 0:266cc01fc2c3 | 46 | pc.printf ("pwm1 = %.5f pwm2 = %.5f\n", pwm1, pwm2); |
Fathoni17 | 0:266cc01fc2c3 | 47 | } |
Fathoni17 | 0:266cc01fc2c3 | 48 | } |