Hugo's Programs / Mbed 2 deprecated PROJECT_Bluetooth_Control_2_Motors

Dependencies:   mbed

Committer:
hugocampos
Date:
Sat Feb 13 18:46:02 2021 +0000
Revision:
2:bc137c43710d
Parent:
1:d33dca22f3a1
Child:
3:40a93d1f3a01
Bluetooth

Who changed what in which revision?

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