Fix robot publishing problems