Moved lcd update out of ISR
moved DriveOutput to DoControl. Removed DoControl from main loop. Clear relay DIO in Complete & Error.
Fixed screen not updating in idle state
Merge pull request #2 from juchong/bryan

Merging Bryan's changes since they have been successfully tested.