Used AngleAxis instead of ThreeAngles for P-term
Changed axis order ZXY to XYZ in osim file & corresponding in control
(resulting in high-precision pelv-orient control)
Added back pelv-pos control, now both pos/orient working precisely togther
(existing issues with knee dof drift)