Small changes before testing of rev1a.
Merge branch 'master' of http://github.com/bluerobotics/BlueESC