Add peak control logic and send out current data on CAN.

Clean up the source and add some documentation.
Fix CAN_tmr bug.
Add CLI() to killCar().