SN8300 Nucleo L152 GSOE Bluetooth HC05

Dependencies:   LCD_i2c_GSOE

main.cpp

Committer:
jack1930
Date:
2022-03-14
Revision:
2:e94f8306c2fe
Parent:
1:e4b0e1c5e332

File content as of revision 2:e94f8306c2fe:

/* mbed Microcontroller Library
 * Copyright (c) 2019 ARM Limited
 * SPDX-License-Identifier: Apache-2.0
 */

#include "mbed.h"
#include "platform/mbed_thread.h"
#include "LCD.h"
#include <Callback.h>

// Blinking rate in milliseconds
#define BLINKING_RATE_MS                                                    500

BufferedSerial hc05(PB_10,PB_11,9600);
DigitalOut links1(PC_0);
DigitalOut links2(PC_1);
DigitalOut rechts1(PC_2);
DigitalOut rechts2(PC_3);
DigitalOut links1_1(PC_4);
DigitalOut links2_1(PC_5);
DigitalOut rechts1_1(PC_6);
DigitalOut rechts2_1(PC_7);
lcd mylcd;
char c;



int main()
{
    char daten[6];

    mylcd.clear();
    mylcd.cursorpos(0);
    mylcd.printf("Roboter go");
    while (true) {
        if (hc05.readable()) 
        {
            hc05.read(daten,1);
            mylcd.cursorpos(0x40);
            mylcd.printf("%d",daten[0]);
            switch(daten[0])
            {
                case 'U':links1=1;links2=0;links1_1=1;links2_1=0;break;
                case 'X':links1=0;links2=0;links1_1=0;links2_1=0;break;
                case 'D':links1=0;links2=1;links1_1=0;links2_1=1;break;
                case 'V':rechts2=1;rechts1=0;rechts2_1=1;rechts1_1=0;break;
                case 'Y':rechts2=0;rechts1=0;rechts2_1=0;rechts1_1=0;break;
                case 'E':rechts2=0;rechts1=1;rechts2_1=0;rechts1_1=1;break;
                case 'W':links1=1;links2=0;rechts2=1;rechts1=0;links1_1=1;links2_1=0;rechts2_1=1;rechts1_1=0;break;
                case 'Z':links1=0;links2=0;rechts2=0;rechts1=0;links1_1=0;links2_1=0;rechts2_1=0;rechts1_1=0;break;
                case 'F':links1=0;links2=1;rechts2=0;rechts1=1;links1_1=0;links2_1=1;rechts2_1=0;rechts1_1=1;break;
            }
        }
        //thread_sleep_for(BLINKING_RATE_MS);
    }
}