Rewritten Vereshchagintest-youbot-motion-matlab
Bugfixes baxter example