Added updateLCD.
Fixed calMode if conditionals.