C-Code für Debugausgabe auf Display

Hallo Forum,
ich bin neu hier, lese aber schon ewig mit. Tolles Forum und super viele 
interessante Projekte!

Da ich mich nun endlich mal an ein Projekt wage (bzw. mir die Zeit dazu 
nehme), habe ich ein Codeschnipsel gesucht und nicht gefunden, daher 
selber gebaut. Vielleicht kann ja noch jemand was damit anfangen. 
Vielleicht ist er auch total unnütz und ich habe ihn mir aus Mangel an 
Erfahrung gewünscht und gebaut. Das wird die Zeit zeigen :-)

Es ist lediglich ein Schnipsel, der an einer Position (X,Y) auf dem 
angeschlossenen Display (nicht Teil des Codes) eine Debugausgabe im 
Format "Gewünschter Text: Registerinhalt in Binärdarstellung" macht. 
Also z.B.: "ADC:00110011".
Ich finde das praktisch :-)

1

void ItoA(uint8_t value, char* buffer, uint8_t radix, uint8_t count) {

2

  uint8_t i = 0;

3

  uint8_t tmp;

4

  do {

5

    buffer[i++] = '0' + value % radix;

6

    value /= radix;

7

    count--;

8

  } while (count > 0);

9

10

  // den String in sich spiegeln

11

  for (count = 0; count < i / 2; ++count) {

12

    tmp = buffer[count];

13

    buffer[count] = buffer[i-count-1];

14

    buffer[i-count-1] = tmp;

15

  }

16

  buffer[i] = '\0';

17

}

18

19

void debugRegister(uint8_t regName, char* text, uint8_t posX, uint8_t posY) {

20

  char buffer[9];

21

  ItoA(regName, buffer, 2, 8);

22

  lcd_set_cursor(posX, posY);

23

  lcd_string(text);

24

  lcd_string(buffer);

25

}

ItoA ist hier aus der Codesammlung, aber dann noch etwas angepasst.

Vielleicht gibt es noch Optimierungspotential... Ich fang' ja erst an 
:-)

Viele Grüße,
Matthias