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@34:3aa1cbcde59d, 2013-06-10 (annotated)
- Committer:
- maetugr
- Date:
- Mon Jun 10 13:22:46 2013 +0000
- Revision:
- 34:3aa1cbcde59d
First version with new ESCs (they are working with the KK Board); some strange kicks in the behaviour of balancing, next step a logger
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 | } |