根据欧拉角计算旋转矩阵

根据 roll, pitch, yaw计算R


```cpp
Eigen::Matrix4f eulerAnglesToTransformationMatrix(float roll, float pitch, float yaw) {

	Eigen::Matrix3f Rx;// 绕x轴的旋转矩阵
	Rx = Eigen::AngleAxisf(roll, Eigen::Vector3f::UnitX());

	Eigen::Matrix3f Ry;// 绕y轴的旋转矩阵
	Ry = Eigen::AngleAxisf(pitch, Eigen::Vector3f::UnitY());

	Eigen::Matrix3f Rz;// 绕z轴的旋转矩阵
	Rz = Eigen::AngleAxisf(yaw, Eigen::Vector3f::UnitZ());

	Eigen::Matrix3f R = Rz * Ry * Rx;// 组合成一个旋转矩阵

	Eigen::Matrix4f transformation = Eigen::Matrix4f::Identity();
	transformation.block<3, 3>(0, 0) = R;

	return transformation;
}

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值