Modeling robot environment for sensor based robot system