updated matlab simulation to be fully kinematic for arbitrary gaits