Kits_talos_electronics/Kit_bluetooth.cpp at master · TalosElectronics-Lab/Kits_talos_electronics · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
#include<Kit_bluetooth.h>

Kit_bluetooth::~Kit_bluetooth() {}

void Kit_bluetooth::init()
{
    Motores_init();
    pinMode(Buzzer,OUTPUT);
    Bluetooth.begin(9600);
    digitalWrite(Buzzer, HIGH);

}

uint8_t Kit_bluetooth::Leer_BT()
{
    if (Bluetooth.available() > 0)
    {
        Estado = Bluetooth.read();
        Serial.println(Estado);
    }
    return Estado;
}
void Kit_bluetooth::modo_bluetooth()
{
    int Velocidad_Max = 255;
    int Velocidad_Med = 150;
    Estado = Leer_BT();
    if (Estado == '1')
    {
        //Arriba_Izquierda
        Motores_mv(Velocidad_Med, Velocidad_Max);
    }
    if (Estado == '2')
    {
        //Derecho
        Motores_mv(Velocidad_Max, Velocidad_Max);
    }
    if (Estado == '3')
    {
        //Arriba_Derecha
        Motores_mv(Velocidad_Max, Velocidad_Med);
    }
    if (Estado == '4')
    {
        //Girar a la izquierda
        Motores_mv(-Velocidad_Max, Velocidad_Max);
    }
    if (Estado == '5')
    {
        //Serial.println("Logo talos");
        digitalWrite(Buzzer,LOW);
    }
    if (Estado == '6')
    {
        //Girar a la derecha
        Motores_mv(Velocidad_Max, -Velocidad_Max);
    }
    if (Estado == '7')
    {
        //Abajo Izquierda
        Motores_mv(-Velocidad_Med, -Velocidad_Max);
    }
    if (Estado == '8')
    {
        //Reversa
        Motores_mv(-Velocidad_Max, -Velocidad_Max);
    }
    if (Estado == '9')
    {
        //Abajo Derecha
        Motores_mv(-Velocidad_Max, -Velocidad_Med);
    }
    if (Estado == 'w')
    {
        Motores_mv(0, 0);
        digitalWrite(Buzzer, HIGH);
    }
}