hc05 and ln298

Dependencies:   mbed-src

Committer:
leoferreira
Date:
Wed May 11 00:38:02 2016 +0000
Revision:
0:e289939710df
Bluetooth hc05 and driver ln298

Who changed what in which revision?

UserRevisionLine numberNew contents of line
leoferreira 0:e289939710df 1 #include "mbed.h"
leoferreira 0:e289939710df 2
leoferreira 0:e289939710df 3 PwmOut ena(D7);
leoferreira 0:e289939710df 4 PwmOut enb(D6);
leoferreira 0:e289939710df 5 DigitalOut in1 (D5);
leoferreira 0:e289939710df 6 DigitalOut in2 (D4);
leoferreira 0:e289939710df 7 DigitalOut in3 (D3);
leoferreira 0:e289939710df 8 DigitalOut in4 (D2);
leoferreira 0:e289939710df 9
leoferreira 0:e289939710df 10 Serial pc(USBTX, USBRX); // liga direto
leoferreira 0:e289939710df 11
leoferreira 0:e289939710df 12
leoferreira 0:e289939710df 13 Serial blue(PTC4, PTC3);
leoferreira 0:e289939710df 14
leoferreira 0:e289939710df 15 float vela=1.0f; //ENGINE SPEED
leoferreira 0:e289939710df 16 float velb=0.05935f; //ENGINE SPEED
leoferreira 0:e289939710df 17
leoferreira 0:e289939710df 18 int main()
leoferreira 0:e289939710df 19 {
leoferreira 0:e289939710df 20 char estado='x';
leoferreira 0:e289939710df 21 blue.baud(9600);
leoferreira 0:e289939710df 22
leoferreira 0:e289939710df 23 while(1){
leoferreira 0:e289939710df 24 if(blue.readable()>0) {
leoferreira 0:e289939710df 25 estado=blue.getc(); //<- HOW TO READ THE CHARACTER THAT SENT WITH THE APPLICATION
leoferreira 0:e289939710df 26
leoferreira 0:e289939710df 27 if(estado=='f') { // Vai para frente
leoferreira 0:e289939710df 28 ena.write(vela);
leoferreira 0:e289939710df 29 in1.write(1);
leoferreira 0:e289939710df 30 in2.write(0);
leoferreira 0:e289939710df 31 enb.write(velb);
leoferreira 0:e289939710df 32 in3.write(0);
leoferreira 0:e289939710df 33 in4.write(1);
leoferreira 0:e289939710df 34
leoferreira 0:e289939710df 35 }
leoferreira 0:e289939710df 36 if(estado=='a') { // Vai para tras
leoferreira 0:e289939710df 37 ena.write(vela);
leoferreira 0:e289939710df 38 in1.write(0);
leoferreira 0:e289939710df 39 in2.write(1);
leoferreira 0:e289939710df 40 enb.write(velb);
leoferreira 0:e289939710df 41 in3.write(1);
leoferreira 0:e289939710df 42 in4.write(0);
leoferreira 0:e289939710df 43 }
leoferreira 0:e289939710df 44 if(estado=='d') { // Vai para direita
leoferreira 0:e289939710df 45 ena.write(vela);
leoferreira 0:e289939710df 46 in1.write(0);
leoferreira 0:e289939710df 47 in2.write(1);
leoferreira 0:e289939710df 48 enb.write(velb);
leoferreira 0:e289939710df 49 in3.write(0);
leoferreira 0:e289939710df 50 in4.write(1);
leoferreira 0:e289939710df 51 }
leoferreira 0:e289939710df 52 if(estado=='e') { // Vai para a esquerda
leoferreira 0:e289939710df 53 ena.write(vela);
leoferreira 0:e289939710df 54 in1.write(1);
leoferreira 0:e289939710df 55 in2.write(0);
leoferreira 0:e289939710df 56 enb.write(velb);
leoferreira 0:e289939710df 57 in3.write(1);
leoferreira 0:e289939710df 58 in4.write(0);
leoferreira 0:e289939710df 59 }
leoferreira 0:e289939710df 60
leoferreira 0:e289939710df 61 /* if(estado=='b') { // BACK
leoferreira 0:e289939710df 62 motor1a.write(0);
leoferreira 0:e289939710df 63 motor2a.write(0);
leoferreira 0:e289939710df 64 motor1b.write(vel);
leoferreira 0:e289939710df 65 motor2b.write(vel);
leoferreira 0:e289939710df 66 }*/
leoferreira 0:e289939710df 67 if (estado =='o') { // ON REMOTE SENSING
leoferreira 0:e289939710df 68
leoferreira 0:e289939710df 69 }
leoferreira 0:e289939710df 70 if (estado=='x') { // OFF REMOTE SENSING
leoferreira 0:e289939710df 71 }
leoferreira 0:e289939710df 72 }
leoferreira 0:e289939710df 73 }
leoferreira 0:e289939710df 74 }