control_loop_cmu_torque_gain.cpp

add static double ErrorVelocity and ErrorPosition
However, I think this one is the same as the original version.