NOT FINISHED YET!!! My first try to get a self built fully working Quadrocopter based on an mbed, a self built frame and some other more or less cheap parts.

Dependencies:   mbed MODI2C

Committer:
maetugr
Date:
Fri Feb 14 14:17:32 2014 +0000
Revision:
40:2ca410923691
Parent:
34:3aa1cbcde59d
now with MPU6050 before taking it too FlyBed2

Who changed what in which revision?

UserRevisionLine numberNew contents of line
maetugr 34:3aa1cbcde59d 1 #include "PC.h"
maetugr 34:3aa1cbcde59d 2 #include "mbed.h"
maetugr 34:3aa1cbcde59d 3
maetugr 34:3aa1cbcde59d 4 PC::PC(PinName tx, PinName rx, int baudrate) : Serial(tx, rx)
maetugr 34:3aa1cbcde59d 5 {
maetugr 34:3aa1cbcde59d 6 baud(baudrate);
maetugr 34:3aa1cbcde59d 7 cls();
maetugr 34:3aa1cbcde59d 8
maetugr 34:3aa1cbcde59d 9 command[0] = '\0';
maetugr 34:3aa1cbcde59d 10 command_char_count = 0;
maetugr 34:3aa1cbcde59d 11 }
maetugr 34:3aa1cbcde59d 12
maetugr 34:3aa1cbcde59d 13
maetugr 34:3aa1cbcde59d 14 void PC::cls()
maetugr 34:3aa1cbcde59d 15 {
maetugr 34:3aa1cbcde59d 16 printf("\x1B[2J");
maetugr 34:3aa1cbcde59d 17 }
maetugr 34:3aa1cbcde59d 18
maetugr 34:3aa1cbcde59d 19
maetugr 34:3aa1cbcde59d 20 void PC::locate(int Spalte, int Zeile)
maetugr 34:3aa1cbcde59d 21 {
maetugr 34:3aa1cbcde59d 22 printf("\x1B[%d;%dH", Zeile + 1, Spalte + 1);
maetugr 34:3aa1cbcde59d 23 }
maetugr 34:3aa1cbcde59d 24
maetugr 34:3aa1cbcde59d 25 void PC::readcommand(void (*executer)(char*))
maetugr 34:3aa1cbcde59d 26 {
maetugr 34:3aa1cbcde59d 27 char input = getc(); // get the character from serial bus
maetugr 34:3aa1cbcde59d 28 if(input == '\r') { // if return was pressed, the command must be executed
maetugr 34:3aa1cbcde59d 29 command[command_char_count] = '\0';
maetugr 34:3aa1cbcde59d 30 executer(&command[0]);
maetugr 34:3aa1cbcde59d 31
maetugr 34:3aa1cbcde59d 32 command_char_count = 0; // reset command
maetugr 34:3aa1cbcde59d 33 command[command_char_count] = '\0';
maetugr 34:3aa1cbcde59d 34 } else if (command_char_count < COMMAND_MAX_LENGHT) {
maetugr 34:3aa1cbcde59d 35 command[command_char_count] = input;
maetugr 34:3aa1cbcde59d 36 command_char_count++;
maetugr 34:3aa1cbcde59d 37 }
maetugr 34:3aa1cbcde59d 38 }