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.
PC/PC.cpp@40:2ca410923691, 2014-02-14 (annotated)
- 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?
User | Revision | Line number | New 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 | } |