Add callback for getting robot position