Vector3d marker_o= Eigen::Vector3d::Zero();
Vector3d marker_x=Eigen::Vector3d::Zero();
Vector3d marker_yy= Eigen::Vector3d::Zero();
Vector3d marker_ox= Eigen::Vector3d::Zero();
Vector3d marker_oyy= Eigen::Vector3d::Zero();
Vector3d marker_oy= Eigen::Vector3d::Zero();
Vector3d marker_oz= Eigen::Vector3d::Zero();
for (int i = 0; i < 3; i++)
{
marker_o(i) = a[i];
marker_x(i) = b[i];
marker_yy(i) = c[i];
}
marker_ox = marker_x - marker_o;
marker_oyy = marker_yy - marker_o;
marker_oz = marker_ox.cross(marker_oyy);
marker_oy = marker_oz.cross(marker_ox);
marker_ox /= marker_ox.norm();
marker_oy /= marker_oy.norm();
marker_oz /= marker_oz.norm();
for (int i = 0; i < 3; i++)
{
TR(i, 0) = marker_ox(i);
TR(i, 1) = marker_oy(i);
TR(i, 2) = marker_oz(i);
TR(i, 3) = marker_o(i);
}
```c++
```
你好,我是有问必答小助手,非常抱歉,本次您提出的有问必答问题,技术专家团超时未为您做出解答
本次提问扣除的有问必答次数,将会以问答VIP体验卡(1次有问必答机会、商城购买实体图书享受95折优惠)的形式为您补发到账户。
因为有问必答VIP体验卡有效期仅有1天,您在需要使用的时候【私信】联系我,我会为您补发。