右手系转Unity左手系坐标系

右手系转Unity左手系坐标系

cpp 复制代码
inline Sophus::SE3d TransformRightPoseToLeftUnity(const Sophus::SE3d &pose)
{
    Eigen::Matrix4d T_wl_wr, T_br_bl;
    T_wl_wr.setZero();
    T_wl_wr(0, 0) = 1.0;
    T_wl_wr(1, 2) = 1.0;
    T_wl_wr(2, 1) = 1.0;
    T_wl_wr(3, 3) = 1.0;

    T_br_bl.setZero();
    T_br_bl(0, 0) = 1.0;
    T_br_bl(1, 1) = -1.0;
    T_br_bl(2, 2) = 1.0;
    T_br_bl(3, 3) = 1.0;

    Eigen::Matrix4d T_wl_bl_mat = T_wl_wr * pose.matrix() * T_br_bl;
    Eigen::Quaterniond q(T_wl_bl_mat.block<3, 3>(0, 0));
    q.normalize();
    return Sophus::SE3d(q, T_wl_bl_mat.block<3, 1>(0, 3));
}
相关推荐
牙膏上的小苏打233315 小时前
Unity Surround开关后导致获取主显示器分辨率错误
unity·主屏幕
Unity大海17 小时前
诠视科技Unity SDK开发环境配置、项目设置、apk打包。
科技·unity·游戏引擎
浅陌sss1 天前
Unity中 粒子系统使用整理(一)
unity·游戏引擎
维度攻城狮1 天前
实现在Unity3D中仿真汽车,而且还能使用ros2控制
python·unity·docker·汽车·ros2·rviz2
为你写首诗ge1 天前
【Unity网络编程知识】FTP学习
网络·unity
神码编程1 天前
【Unity】 HTFramework框架(六十四)SaveDataRuntime运行时保存组件参数、预制体
unity·编辑器·游戏引擎
菲fay1 天前
Unity 单例模式写法
unity·单例模式
火一线1 天前
【Framework-Client系列】UIGenerate介绍
游戏·unity
ZKY_242 天前
【工具】Json在线解析工具
unity·json