Ausserdem empfiehlt es sich die Variable zu deklarieren und dann alles andere in eine while-Schleife zu packen, da das Programm sonst nur 1x durchlaufen wird und nachher seltsame Effekte auftreten können. (Das mit den seltsamen Effekten hab ich nur vom Hörnsagen, dass dein Programm in dieser Variante aber nur einmal durchlaufen wird ist Tatsache)

Dein Programm sollte besser so strukturiert sein:
Deklaration und Initialisierung aller Variablen (auch durch den Aufruf von initRobotBase()
While (1)
{
Ausgabe
Eingabe
Vergleich
Ausgabe
}