main.cpp

00001 /* mbed Microcontroller Library
00002  * Copyright (c) 2019 ARM Limited
00003  * SPDX-License-Identifier: Apache-2.0
00004  */
00005 
00006 #include "mbed.h"
00007 #include "platform/mbed_thread.h"
00008 #include "LCD.h"
00009 #include <Callback.h>
00010 
00011 // Blinking rate in milliseconds
00012 #define BLINKING_RATE_MS                                                    500
00013 
00014 BufferedSerial hc05(PB_10,PB_11,9600);
00015 DigitalOut links1(PC_0);
00016 DigitalOut links2(PC_1);
00017 DigitalOut rechts1(PC_2);
00018 DigitalOut rechts2(PC_3);
00019 DigitalOut links1_1(PC_4);
00020 DigitalOut links2_1(PC_5);
00021 DigitalOut rechts1_1(PC_6);
00022 DigitalOut rechts2_1(PC_7);
00023 lcd mylcd;
00024 char c;
00025 
00026 
00027 
00028 int main()
00029 {
00030     char daten[6];
00031 
00032     mylcd.clear();
00033     mylcd.cursorpos(0);
00034     mylcd.printf("Roboter go");
00035     while (true) {
00036         if (hc05.readable()) 
00037         {
00038             hc05.read(daten,1);
00039             mylcd.cursorpos(0x40);
00040             mylcd.printf("%d",daten[0]);
00041             switch(daten[0])
00042             {
00043                 case 'U':links1=1;links2=0;links1_1=1;links2_1=0;break;
00044                 case 'X':links1=0;links2=0;links1_1=0;links2_1=0;break;
00045                 case 'D':links1=0;links2=1;links1_1=0;links2_1=1;break;
00046                 case 'V':rechts2=1;rechts1=0;rechts2_1=1;rechts1_1=0;break;
00047                 case 'Y':rechts2=0;rechts1=0;rechts2_1=0;rechts1_1=0;break;
00048                 case 'E':rechts2=0;rechts1=1;rechts2_1=0;rechts1_1=1;break;
00049                 case 'W':links1=1;links2=0;rechts2=1;rechts1=0;links1_1=1;links2_1=0;rechts2_1=1;rechts1_1=0;break;
00050                 case 'Z':links1=0;links2=0;rechts2=0;rechts1=0;links1_1=0;links2_1=0;rechts2_1=0;rechts1_1=0;break;
00051                 case 'F':links1=0;links2=1;rechts2=0;rechts1=1;links1_1=0;links2_1=1;rechts2_1=0;rechts1_1=1;break;
00052             }
00053         }
00054         //thread_sleep_for(BLINKING_RATE_MS);
00055     }
00056 }