Added debug_lcd_print & finalized debug_lcd_init