Fully working and Tested. New programming, new calibration

New calibration.
Better programming.
Know issue: Freeze of CPU due to power spikes from RC car. Not SW releated.

First working version

Fully working 5 hour project. Check readme and code for details.