LCD.c program works but needs cleaning