Ask Your Question

Revision history [back]

Sounds like you want to use the image_geometry package. It contains convenience functionality for working with standard ROS camera models (initialized from a CameraInfo message). Specifically, the PinholeCameraModel::fullProjectionMatrix and PinholeCameraModel::projectPixelTo3dRay methods sound like what you´re looking for. See also the associated tutorial for info on how to initialize things from a CameraInfo in a node.