new version of nav_to_poi
Merge branch 'master' of https://github.com/reem-utils/robocup2014