only draw walls when calibrated
pack classified objects and draw them in rviz