effectorTrajectoryGenerator3D.m
modelODE.m
start.m