@@ -480,6 +480,31 @@ void Freenect2DeviceImpl::start()
480480 rgb_camera_params_.cx = rgb_p->color_cx ;
481481 rgb_camera_params_.cy = rgb_p->color_cy ;
482482
483+ rgb_camera_params_.shift_d = rgb_p->shift_d ;
484+ rgb_camera_params_.shift_m = rgb_p->shift_m ;
485+
486+ rgb_camera_params_.mx_x3y0 = rgb_p->mx_x3y0 ; // xxx
487+ rgb_camera_params_.mx_x0y3 = rgb_p->mx_x0y3 ; // yyy
488+ rgb_camera_params_.mx_x2y1 = rgb_p->mx_x2y1 ; // xxy
489+ rgb_camera_params_.mx_x1y2 = rgb_p->mx_x1y2 ; // yyx
490+ rgb_camera_params_.mx_x2y0 = rgb_p->mx_x2y0 ; // xx
491+ rgb_camera_params_.mx_x0y2 = rgb_p->mx_x0y2 ; // yy
492+ rgb_camera_params_.mx_x1y1 = rgb_p->mx_x1y1 ; // xy
493+ rgb_camera_params_.mx_x1y0 = rgb_p->mx_x1y0 ; // x
494+ rgb_camera_params_.mx_x0y1 = rgb_p->mx_x0y1 ; // y
495+ rgb_camera_params_.mx_x0y0 = rgb_p->mx_x0y0 ; // 1
496+
497+ rgb_camera_params_.my_x3y0 = rgb_p->my_x3y0 ; // xxx
498+ rgb_camera_params_.my_x0y3 = rgb_p->my_x0y3 ; // yyy
499+ rgb_camera_params_.my_x2y1 = rgb_p->my_x2y1 ; // xxy
500+ rgb_camera_params_.my_x1y2 = rgb_p->my_x1y2 ; // yyx
501+ rgb_camera_params_.my_x2y0 = rgb_p->my_x2y0 ; // xx
502+ rgb_camera_params_.my_x0y2 = rgb_p->my_x0y2 ; // yy
503+ rgb_camera_params_.my_x1y1 = rgb_p->my_x1y1 ; // xy
504+ rgb_camera_params_.my_x1y0 = rgb_p->my_x1y0 ; // x
505+ rgb_camera_params_.my_x0y1 = rgb_p->my_x0y1 ; // y
506+ rgb_camera_params_.my_x0y0 = rgb_p->my_x0y0 ; // 1
507+
483508 command_tx_.execute (ReadStatus0x090000Command (nextCommandSeq ()), result);
484509 std::cout << " [Freenect2DeviceImpl] ReadStatus0x090000 response" << std::endl;
485510 std::cout << GenericResponse (result.data , result.length ).toString () << std::endl;
0 commit comments