oops i was off by one link in the frame computations for the eample robot
First steps towards separate constraint and objective subtypes for tasks.
every waypoint will need its own set of constraints...
Riesenbaustelle (working toward acceleration-based objectives with
velocity-based constraints).