已知相机到车的rt 4x4矩阵,求pitch和yaw角度

0.01236276, -0.03470584, 0.9993211, 2.052727

-0.99991938, 0.00246558, 0.01245579, -0.0054

-0.00289619, -0.99939453, -0.03467256, 1.4633291

0.0, 0.0, 0.0, 1.0

最终结论

这个相机:

pitch ≈ +2.0°

表示:pitch角度正,相机向下。右手大拇指向左,和y轴方向一样,四指向下,向下为正。

相机略微向下俯视(自动驾驶非常常见)

复制代码
import numpy as np

R = np.array([
    [ 0.01236276, -0.03470584,  0.9993211 ],
    [-0.99991938,  0.00246558,  0.01245579],
    [-0.00289619, -0.99939453, -0.03467256]
])

forward = R[:, 2]

pitch = np.arcsin(-forward[2]) * 180 / np.pi

print(pitch)
#1.986°
复制代码
pitch = asin(-f_z)
yaw   = atan2(f_y, f_x)
相关推荐
kobesdu5 小时前
从零推导FAST-LIO的观测雅可比矩阵
人工智能·算法·矩阵
PHOSKEY8 小时前
具身机器人行星滚柱丝杠核心尺寸测量与光子精密QM系列闪测仪应用
数码相机
就是个名称21 小时前
cesium 地球地固转地惯
数码相机
LayZhangStrive1 天前
线性代数 - 第1章 行列式
人工智能·线性代数·机器学习
AttosTek1 天前
-80℃深度制冷短波红外相机选型指南
数码相机
落苜蓿蓝1 天前
多张覆盖视场的平面棋盘图片; 、对每张图片用 OpenCV 的 findChessboardCorners 检测内角点并用 corn ...
数码相机·opencv·平面
CreBee1 天前
CreBee功能大全:新媒体矩阵运营有哪些能力?
矩阵·新媒体运营·媒体
取个名字太难了~2 天前
最新手机外接相机实时传输 + 动态美颜完整项目源码
android·数码相机·智能手机·美颜·相机连接·demu
爱吃提升2 天前
MATLAB矩阵运算完全指南:从生成到索引操作
数据结构·matlab·矩阵
天天有money2 天前
API中转站在社媒矩阵里的价值:多平台文案如何统一改写
gpt·线性代数·ai·chatgpt·矩阵