hc05 and ln298
main.cpp@0:e289939710df, 2016-05-11 (annotated)
- 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?
User | Revision | Line number | New 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 | } |