Ah yes, starting to look really good: here's a demo with added
obstacle avoidance /constraints/ that shows the system's overall
robustness. You can still get jitter and even some hyperspace effects
when placing the obstacle onto the end effector goal, but that is to
be expected with the issues pointed out by Mistry:2007.