@ controllers/epuck_controller/gotoPointDiff.h: tested and some fix applied