Board Garudago >> Motor6 --> 1 || Motor2 --> 2 key board: A S --> control pwm1 K L --> control pwm2

Dependencies:   Motor mbed

Board Garudago (Motor6 ==> 1 || Motor2 ==> 2)

key board

  • A S : control pwm1
  • K L : control pwm2
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?

UserRevisionLine numberNew 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 }