Project

General

Profile

Statistics
| Revision:

root / trunk / code / projects / colonet / utilities / manual_control / manualControlRobot / help.h @ 13

History | View | Annotate | Download (663 Bytes)

1
#include "serial.h"
2

    
3
char helper(char c){
4
        switch(c){
5
                case 0x00: return '0';
6
                case 0x01: return '1';
7
                case 0x02: return '2';
8
                case 0x03: return '3';
9
                case 0x04: return '4';
10
                case 0x05: return '5';
11
                case 0x06: return '6';
12
                case 0x07: return '7';
13
                case 0x08: return '8';
14
                case 0x09: return '9';
15
                case 0x0A: return 'A';
16
                case 0x0B: return 'B';
17
                case 0x0C: return 'C';
18
                case 0x0D: return 'D';
19
                case 0x0E: return 'E';
20
                case 0x0F: return 'F';
21
                default: return '?';
22
        }
23
}
24

    
25
void print_hex(char val){
26
        char hgh = (val & 0xF0) >> 4;
27
        char low = (val & 0x0F);
28
        
29
        serial1_putchar(helper(hgh));
30
        serial1_putchar(helper(low));
31
}