Updated CommandProcessor class to print angle errors with current angle.
Merge branch 'PID' of https://github.com/gcc-robotics/prometheus into PID