Hugo's Programs / Mbed 2 deprecated PROJECT_Bluetooth_Control_1_Motors

Dependencies:   mbed

Committer:
hugocampos
Date:
Sat Feb 13 18:51:53 2021 +0000
Revision:
2:9c890a4ddf0e
Parent:
1:d33dca22f3a1
Bluetooth

Who changed what in which revision?

UserRevisionLine numberNew contents of line
hugocampos 2:9c890a4ddf0e 1 /*
hugocampos 2:9c890a4ddf0e 2 *Programa com IHM04A1 e bluetooth com 1 motor
hugocampos 2:9c890a4ddf0e 3 *Autor: Hugo Campos
hugocampos 2:9c890a4ddf0e 4 *Data:04/10/2020
hugocampos 2:9c890a4ddf0e 5 *Status: Funcionando
hugocampos 2:9c890a4ddf0e 6 */
YARodriguez 0:1cd78549370a 7
hugocampos 2:9c890a4ddf0e 8 #include "mbed.h"
mariangelamone 1:d33dca22f3a1 9
mariangelamone 1:d33dca22f3a1 10
hugocampos 2:9c890a4ddf0e 11 DigitalOut IN1B (D5);
hugocampos 2:9c890a4ddf0e 12 DigitalOut IN2B (D4);
hugocampos 2:9c890a4ddf0e 13 PwmOut ENB (D2);
hugocampos 2:9c890a4ddf0e 14
YARodriguez 0:1cd78549370a 15
hugocampos 2:9c890a4ddf0e 16 Serial bt(PA_11,PA_12); //(D10,D2)
hugocampos 2:9c890a4ddf0e 17 Serial pc(USBTX,USBRX);
mariangelamone 1:d33dca22f3a1 18
hugocampos 2:9c890a4ddf0e 19 int main()
YARodriguez 0:1cd78549370a 20 {
hugocampos 2:9c890a4ddf0e 21 float dutyENB = 0.15;
hugocampos 2:9c890a4ddf0e 22 bt.baud(9600);
hugocampos 2:9c890a4ddf0e 23
hugocampos 2:9c890a4ddf0e 24
hugocampos 2:9c890a4ddf0e 25 bt.printf("Connection Established");
hugocampos 2:9c890a4ddf0e 26
hugocampos 2:9c890a4ddf0e 27 pc.printf("Connection Established");
hugocampos 2:9c890a4ddf0e 28 while(1) {
hugocampos 2:9c890a4ddf0e 29
hugocampos 2:9c890a4ddf0e 30 if (bt.readable()) {
hugocampos 2:9c890a4ddf0e 31 char CONTROL= bt.putc(bt.getc());
hugocampos 2:9c890a4ddf0e 32
hugocampos 2:9c890a4ddf0e 33
hugocampos 2:9c890a4ddf0e 34 if(CONTROL == 'D') {
hugocampos 2:9c890a4ddf0e 35 ENB.write(dutyENB);
hugocampos 2:9c890a4ddf0e 36 IN1B = 0;
hugocampos 2:9c890a4ddf0e 37 IN2B = 1;
hugocampos 2:9c890a4ddf0e 38 bt.printf("motor para direita");
hugocampos 2:9c890a4ddf0e 39 wait_ms(500);
hugocampos 2:9c890a4ddf0e 40 }
hugocampos 2:9c890a4ddf0e 41
hugocampos 2:9c890a4ddf0e 42
hugocampos 2:9c890a4ddf0e 43 if(CONTROL == 'E') {
hugocampos 2:9c890a4ddf0e 44 ENB.write(dutyENB);
hugocampos 2:9c890a4ddf0e 45 IN1B = 1;
hugocampos 2:9c890a4ddf0e 46 IN2B = 0;
hugocampos 2:9c890a4ddf0e 47 bt.printf("motor para esquerda");
hugocampos 2:9c890a4ddf0e 48 wait_ms(500);
hugocampos 2:9c890a4ddf0e 49 }
hugocampos 2:9c890a4ddf0e 50 if(CONTROL == 'S') {
hugocampos 2:9c890a4ddf0e 51 ENB = 0.0;
hugocampos 2:9c890a4ddf0e 52 IN1B = 0;
hugocampos 2:9c890a4ddf0e 53 IN2B = 0;
hugocampos 2:9c890a4ddf0e 54 pc.printf("motor parado");
hugocampos 2:9c890a4ddf0e 55 wait_ms(500);
hugocampos 2:9c890a4ddf0e 56 }
hugocampos 2:9c890a4ddf0e 57 ENB = 0;
hugocampos 2:9c890a4ddf0e 58
hugocampos 2:9c890a4ddf0e 59 }
hugocampos 2:9c890a4ddf0e 60
hugocampos 2:9c890a4ddf0e 61 if (pc.readable()) {
hugocampos 2:9c890a4ddf0e 62 char CONTROL= pc.putc(pc.getc());
hugocampos 2:9c890a4ddf0e 63 if(CONTROL == 'E') {
hugocampos 2:9c890a4ddf0e 64 ENB.write(dutyENB);
hugocampos 2:9c890a4ddf0e 65 IN1B = 1;
hugocampos 2:9c890a4ddf0e 66 IN2B = 0;
hugocampos 2:9c890a4ddf0e 67 pc.printf("motor para esquerda");
hugocampos 2:9c890a4ddf0e 68 wait_ms(500);
hugocampos 2:9c890a4ddf0e 69 }
hugocampos 2:9c890a4ddf0e 70 if(CONTROL == 'D') {
hugocampos 2:9c890a4ddf0e 71 ENB.write(dutyENB);
hugocampos 2:9c890a4ddf0e 72 IN1B = 0;
hugocampos 2:9c890a4ddf0e 73 IN2B = 1;
hugocampos 2:9c890a4ddf0e 74 pc.printf("motor para direita");
hugocampos 2:9c890a4ddf0e 75 wait_ms(500);
hugocampos 2:9c890a4ddf0e 76 }
hugocampos 2:9c890a4ddf0e 77 if(CONTROL == 'S') {
hugocampos 2:9c890a4ddf0e 78 ENB = 0.0;
hugocampos 2:9c890a4ddf0e 79 IN1B = 0;
hugocampos 2:9c890a4ddf0e 80 IN2B = 0;
hugocampos 2:9c890a4ddf0e 81 pc.printf("motor parado");
hugocampos 2:9c890a4ddf0e 82 wait_ms(500);
hugocampos 2:9c890a4ddf0e 83 }
hugocampos 2:9c890a4ddf0e 84 ENB=0.0;
hugocampos 2:9c890a4ddf0e 85 }
YARodriguez 0:1cd78549370a 86 }
hugocampos 2:9c890a4ddf0e 87
hugocampos 2:9c890a4ddf0e 88 }