Test routine and extra routines to contol LCD