Ich kann auf ein Beispielprojekt verweisen, wo ich das mache. Es wird eine printf-ähnliche Funktion definiert, die neben den normalen Direktiven wie "%d" auch Direktiven wie Cursor-Positionierung auf einem LCD unterstützt.

Guckst

http://people.freenet.de/gjl/pub/ebook/

im Abschnitt "Software". Die Quellen sind dokumentiert.