Complementary material for the submission RAL-ICRA 2017 - View it on GitHub