Modified simulink modle and calling code - added actuator saturation and contact saturation blocks to the model
Need to check back on some units as the system is unstable at all attempted gains thus far
Added back EMF into plant model
Added Torque mode control example code from ME447 into repository
added new models to test various versions of the components of the control system