Eigen库 C++中的输出某个元素

首先带有头文件

#include <Eigen/Core>

void  Solve_robot::eulerAnglesToRotationMatrix(std::vector<double> &pos, Eigen::Matrix3d &matrix_RXYZ) {
    Eigen::Matrix3d R_x;    // 计算旋转矩阵的X分量

    std::vector<double> Euler_angle;
    //转为变换矩阵
    for (int i = 3; i < 6; ++i)
    {
        Euler_angle.emplace_back(pos[i] *M_PI / 180);
    }
    R_x <<
        1, 0, 0,
            0, cos(Euler_angle[2]), -sin(Euler_angle[2]),
            0, sin(Euler_angle[2]), cos(Euler_angle[2]);

    Eigen::Matrix3d R_y;    // 计算旋转矩阵的Y分量
    R_y <<
        cos(Euler_angle[1]), 0, sin(Euler_angle[1]),
            0, 1, 0,
            -sin(Euler_angle[1]), 0, cos(Euler_angle[1]);

    Eigen::Matrix3d R_z;    // 计算旋转矩阵的Z分量
    R_z <<
        cos(Euler_angle[0]), -sin(Euler_angle[0]), 0,
            sin(Euler_angle[0]), cos(Euler_angle[0]), 0,
            0, 0, 1;
    //返回旋转矩阵
    matrix_RXYZ = R_z * R_y * R_x;
//输出整个矩阵
   std::cout<< matrix_RXYZ<<std::endl;
  //输出单个元素,下标从0,0开始的
     std::cout<< matrix_RXYZ(0,0<<std::endl;
}

以上代码为欧拉较转旋转矩阵3*3
//同理 对其赋值也是按照
matrix_RXYZ(0,0)=1;此时 就对 matrix_RXYZ(0,0)中第一行第一个元素赋值为1;

std::cout<< matrix_RXYZ(0,0)<<std::endl; 输出某个元素
记录完毕~~~~~~~~~~~

  • 0
    点赞
  • 0
    收藏
    觉得还不错? 一键收藏
  • 打赏
    打赏
  • 0
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

起个网名真难~

你的鼓励将是我创作的最大动力

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付:¥1
获取中
扫码支付

您的余额不足,请更换扫码支付或充值

打赏作者

实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

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

余额充值