Working version. Still some issues with the LCD.