firsts test on the robot, it doesn't work the nav to poi
Merge pull request #196 from reem-utils/roger_branch

 firsts test on the robot, it doesn't work the nav to poi