Ich hab das getestet (außer der LCD-Ausgabe, sowas hab ich nich), das funzt.
es kann nur ein fehler sein mit "locate" u. "LCD", da muß ich leider passen