refactor action server with callbacks
externalize static for geometric calculations
eliminate redundant move_base goal updates, fix locking