fixing robot dimensions and integrating with Robomap