very simple base planning case runs and goes towards goal!
both adaptive motion primitives work!
fixed bugs in amps
adding transition data
path reconstruction works! also added workspaceinterpolation
added torso motion primitive