Updated with ability to dynamically FIND error. Still need to save it and calculate FB torque.