已知相机到车的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)
相关推荐
零依赖极客10 小时前
Day 6·1 ARMv8.2 dotprod——vdotq_s32 一条指令做 4 个点积
c语言·开发语言·人工智能·矩阵·arm·vllm
wzdark12 小时前
基于矩阵的动态规划路径问题性能优化4
线性代数·矩阵·动态规划
视觉工程师070617 小时前
工业相机选择CCD 还是 CMOS
数码相机·视觉检测
FLJwu1 天前
运动相机 ID 外观与壳体开模实战 02:壳体注塑缺陷|缩水、气泡、披风、熔接痕量产改善方案|20 年源头工厂量产经验
经验分享·数码相机·相机
高升说1 天前
多相机同步怎么选:硬件同步与软件同步的原理、对比与选型流程
人工智能·数码相机
明志数科1 天前
从300克Ego头环看第一人称数据采集趋势:设备轻量化之后,场景端壁垒在哪
数码相机·学习
Raas1002 天前
MAI Gateway(魔芋企业级AI网关)功能全解:AI网关有哪些功能?一文看懂AI网关能力矩阵
大数据·人工智能·矩阵·gateway·mai gateway·企业级产品
FLJwu2 天前
运动相机 ID 外观与壳体开模实战 01:ID 造型、拔模角度、壁厚设计 OEM 量产避坑|20 年源头工厂量产经验
经验分享·数码相机·相机
qq_526099132 天前
视觉检测工控机丢帧、掉线、卡顿,分别是什么原因?按这张表查
数码相机·计算机视觉
船厂电气自动化ai大模型2 天前
AI大模型与数学 第75课 基、维度、向量空间坐标
数据结构·线性代数·算法·机器学习·推荐算法