本文整理汇总了C++中Quaterniond::normalized方法的典型用法代码示例。如果您正苦于以下问题：C++ Quaterniond::normalized方法的具体用法？C++ Quaterniond::normalized怎么用？C++ Quaterniond::normalized使用的例子？那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类Quaterniond的用法示例。
在下文中一共展示了Quaterniond::normalized方法的1个代码示例，这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞，您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: get_robot_position
Vector3d get_robot_position(Vector3d position)
{
Rb2w = att_body.normalized().toRotationMatrix();
Rc2w = Rb2w * Rc2b;
Rc2i = Ri2w.inverse() * Rc2w;
//pos_i is normlized coordinate; the POS_I is the real coordinate; both are in intermidiate frame
Vector3d pos_i, POS_I, POS_W, CAM_W;
pos_i = Rc2i * position.normalized();
pos_i = pos_i / pos_i.z();
POS_I = pos_body.z() * pos_i;
CAM_W = pos_body + Rb2w * cam_off_b;
POS_W = Ri2w * POS_I + CAM_W;
return POS_W;
}