presented at event International Conference on Simulation, Modeling, and Programming for Autonomous Robots (SIMPAR 2014) Conference