本文整理汇总了C++中Pose::SetMatrix方法的典型用法代码示例。如果您正苦于以下问题：C++ Pose::SetMatrix方法的具体用法？C++ Pose::SetMatrix怎么用？C++ Pose::SetMatrix使用的例子？那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类Pose的用法示例。
在下文中一共展示了Pose::SetMatrix方法的1个代码示例，这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞，您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: _Update
double MultiMarkerFiltered::_Update(MarkerIterator &begin, MarkerIterator &end,
Camera* cam, Pose& pose, IplImage* image)
{
if (_GetPose(begin, end, cam, pose, NULL) == -1) return -1;
// For every detected marker
for (MarkerIterator &i = begin.reset(); i != end; ++i)
{
const Marker* marker = *i;
int id = marker->GetId();
int index = get_id_index(id);
if (index < 0) continue;
// Initialize marker pose
if (marker_status[index] == 0)
{
double cam_posed[16];
double mar_posed[16];
CvMat cam_mat = cvMat(4, 4, CV_64F, cam_posed);
CvMat mar_mat = cvMat(4, 4, CV_64F, mar_posed);
pose.GetMatrix(&cam_mat);
marker->pose.GetMatrix(&mar_mat);
cvInvert(&cam_mat, &cam_mat);
cvMatMul(&cam_mat, &mar_mat, &mar_mat);
Pose p;
p.SetMatrix(&mar_mat);
PointCloudAverage(id, marker->GetMarkerEdgeLength(), p);
}
}
// When the pointcloud is updated we will get the new "better" pose...
return _GetPose(begin, end, cam, pose, image);
}