右手系转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));
}
相关推荐
星火撩猿6 小时前
常见游戏引擎介绍与对比
unity·ue5·游戏引擎·godot
sky_smile_Allen7 小时前
[Unity]-[UI]-[Prefab] 关于Unity UGUI 的布局及组件讲解
ui·unity·游戏引擎
太妃糖耶12 小时前
URP-利用矩阵在Shader中实现物体的平移和缩放
unity·矩阵
是阿根1 天前
unity使用iTextSharp生成PDF文件
unity·c#·游戏引擎
常城1 天前
Unity中通过TMP使用图片字体
unity·游戏引擎
惊鸿醉1 天前
⭐Unity 开发 | 如何通过 NTP 网络时间实现精准的跨平台时间同步【附完整源码 + UI 模块 + 偏差分析】
网络·unity·游戏引擎
海鸥-w2 天前
Unity中使用Cinemachine插件创建自由视角相机(freelookCamera)来实现第三人称漫游
数码相机·unity·游戏引擎
EQ-雪梨蛋花汤2 天前
【Unity笔记】Unity音效管理:ScriptableObject配置 + 音量控制 + 编辑器预览播放自动化实现
笔记·unity·编辑器
qq_431331352 天前
Unity ML-Agents + VScode 环境搭建 Windows
windows·vscode·unity·强化学习
林枫依依2 天前
Unity 创建、读取、改写Excel表格数据
unity·excel