USU-ARES-Manipulation-2019 Homebrew inverse kinematics control for USU ARES 2019 rover for URC. Not finished, with lots of extra debug code