Modification in nav_to_poi, now we can set a poi in init. Add test
Some changes, now we can set the time in init
Merge branch 'master' of https://github.com/reem-utils/robocup2014