Add R and P in camera info messages

This commit is contained in:
Henri Rebecq 2018-12-17 16:29:36 +01:00
parent 29d3cca0eb
commit 1241667c33

View File

@ -162,7 +162,12 @@ void cameraToMsg(const ze::Camera::Ptr& camera, Time t, sensor_msgs::CameraInfoP
msg->K = K_vec; msg->K = K_vec;
msg->D = D_vec; msg->D = D_vec;
// TODO: Add R and P msg->P = {K(0,0), 0, K(0,2), 0,
0, K(1,1), K(1,2), 0,
0, 0, 1, 0};
msg->R = {1, 0, 0,
0, 1, 0,
0, 0, 1};
} }