直接贴上代码

//求得对应的相机参数
	k4a_transformation_t transformation = k4a_transformation_create(&sensor_calibration);
	float c_cx = sensor_calibration.color_camera_calibration.intrinsics.parameters.v[0];
	float c_cy = sensor_calibration.color_camera_calibration.intrinsics.parameters.v[1];
	float c_fx = sensor_calibration.color_camera_calibration.intrinsics.parameters.v[2];
	float c_fy = sensor_calibration.color_camera_calibration.intrinsics.parameters.v[3];
//根据对应的相机参数,推断出某一点对应的三维坐标点
				ushort d = depthToColor.ptr<ushort>(y)[x];
				double z = float(d) / 1000;
				double x = (x- c_cx) * z / c_fx;
				double y = (y- c_cy) * z / c_fy;
Logo

魔乐社区(Modelers.cn) 是一个中立、公益的人工智能社区,提供人工智能工具、模型、数据的托管、展示与应用协同服务,为人工智能开发及爱好者搭建开放的学习交流平台。社区通过理事会方式运作,由全产业链共同建设、共同运营、共同享有,推动国产AI生态繁荣发展。

更多推荐