- Found error in Battery Voltage measure routine. Sometimes the int variable had an oveflow. Changed to have unsigned int which works fine
- Added init test routine in state machine to show Battery Voltage in DEBUG Led during start up. An voltage of 4.736 volt shows as 4 blinks, 7 blinks, 3 blinks and 6 blinks
- Some other clean up