Adding a new anchor class for corde. Right now just a cleaned up copy of muscle2p's anchor
Using a different quaternion, and other assumption changes
Fix torque update equations to match spillman's dissertation
Additional parameter tuning and sign changes