Get rid of wait_ms, and LCD_PortB