case_invkin.m casestudy1.mdl extforce.m ExtFTerm.m forward_kin_2link.m IJSMC.m inv_vel_accel.m readme satf.m setup.m stateder.m