1.Fix a bug in InverseKin, that I forgot to add the default joint limits
2. Add fix_initial_state to InverseKinTraj