Robot gravity calibration
Description
Ported robot gravity calibration routine from firmware.
What to focus on
- put content here.
Reviewers
Resources
Firmware version: https://git.barrett.com/firmware/proficio-kinetis-firmware/tree/gravitycal/projects/robot-gravity-calibration/source
Issues
- Fixes #42