本文整理汇总了C++中Pose3D::rotateZ方法的典型用法代码示例。如果您正苦于以下问题:C++ Pose3D::rotateZ方法的具体用法?C++ Pose3D::rotateZ怎么用?C++ Pose3D::rotateZ使用的例子?那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类Pose3D
的用法示例。
在下文中一共展示了Pose3D::rotateZ方法的3个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: calculateHandPos
Pose3D ViewBikeMath::calculateHandPos(const JointData& jointData, const JointData::Joint& joint, const RobotDimensions& robotDimensions)
{
Pose3D handPos;
float sign = joint == JointData::LShoulderPitch ? 1.f : -1.f;
handPos.translate(robotDimensions.armOffset.x, sign * robotDimensions.armOffset.y, robotDimensions.armOffset.z);
handPos.rotateY(-jointData.angles[joint]);
handPos.rotateZ(sign * jointData.angles[joint + 1]);
handPos.translate(robotDimensions.upperArmLength, 0, 0);
handPos.rotateX(jointData.angles[joint + 2] * sign);
handPos.rotateZ(sign * jointData.angles[joint + 3]);
return handPos;
}
示例2: robotWithCameraRotationToImage
bool Transformation::robotWithCameraRotationToImage(const Vector2<>& point,
const CameraMatrix& cameraMatrix, const CameraInfo& cameraInfo,
Vector2<>& pointInImage)
{
Pose3D cameraRotatedMatrix;
cameraRotatedMatrix.rotateZ(cameraMatrix.rotation.getZAngle());
const Vector3<> point3D(point.x, point.y, 0.f);
return robotToImage(cameraRotatedMatrix * point3D, cameraMatrix, cameraInfo, pointInImage);
}
示例3: imageToRobotWithCameraRotation
bool Transformation::imageToRobotWithCameraRotation(const Vector2<int>& pointInImage,
const CameraMatrix& cameraMatrix, const CameraInfo& cameraInfo,
Vector2<>& relativePosition)
{
const bool ret = imageToRobot(pointInImage, cameraMatrix, cameraInfo, relativePosition);
if(ret)
{
Pose3D cameraRotatedMatrix;
cameraRotatedMatrix.rotateZ(cameraMatrix.rotation.getZAngle());
const Vector3<> point3D = cameraRotatedMatrix.invert() * Vector3<>(relativePosition.x, relativePosition.y, 0.f);
relativePosition.x = point3D.x;
relativePosition.y = point3D.y;
}
return ret;
}