已知相机到车的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)
相关推荐
通信小呆呆2 小时前
Vandermonde结构及其快速算法详解
线性代数·算法
木 东6 小时前
图像高亮处过曝,该如何解决
图像处理·数码相机·camera·isp
2601_957418809 小时前
Android相机有线连接(PTP/MTP)协议栈实现与优化实践
数码相机
神仙别闹10 小时前
基于Object3D 实现光线追踪
数码相机·3d
吃好睡好便好11 小时前
矩阵的左乘和右乘
人工智能·学习·线性代数·算法·matlab·矩阵
东方佑13 小时前
从量子矩阵力学到神经网络计算:一种跨学科的数学统一性探索
神经网络·线性代数·矩阵
通信小呆呆13 小时前
Hankel结构及其快速算法详解
线性代数·算法·机器学习
吃好睡好便好13 小时前
矩阵的左除和右除
人工智能·学习·线性代数·算法·矩阵
2601_957787581 天前
企业内容矩阵系统:AI赋能下的全链路运营与获客升级
大数据·人工智能·矩阵