Modified my makefile to be more generic as well as included a debug build. Changed the control codes to output information if built with a debug config. Fixed a few typos. Make code more readable. control now returns a valid boolean. divided command torque by the moment arm in the sim code to match the MATLAB implementation
:x