Updated code with current pins from the schematic.
Refactored display code.