edits to make it compile. Needs revised pinhole_camera_model in vision_opencv to work properly.