世界坐标系，图像坐标系，车体坐标系，雷达坐标系转换

许多场合下都需要用到坐标系的转换，那么坐标系转换中最重要最核心的就是RT矩阵，

$\begin{bmatrix} ax\\ ay\\ az \end{bmatrix}=R*\begin{bmatrix} bx\\ by\\ bz \end{bmatrix}+T$

R矩阵是将坐标系b旋转为坐标系a下的旋转矩阵，T为B坐标系在A坐标系下的坐标，如果要改变方向将A坐标系下的点转换为B坐标系下的点的话，要重新计算新的RT矩阵

$\begin{bmatrix} bx\\ by\\ bz \end{bmatrix}=R'*\begin{bmatrix} ax\\ ay\\ az \end{bmatrix}+T'$

$R'=inv(R); T'=-R'*T;$

从世界坐标系到相机图像的转换：
$a*\begin{bmatrix} c\\ r\\ 1 \end{bmatrix}=K*[R ,T']*\bigl(\begin{smallmatrix} X\\ Y\\ Z\\ 1 \end{smallmatrix}\bigr)$

K矩阵是相机的内参数矩阵，基本计算理论是小孔成像，主要涉及到的参数是相机焦距，x,y轴的像素分辨率(pix/sel)，相机的主点

$K=\begin{bmatrix} fNc &0 &NcPx \\ 0&fNr & NrPy\\ 0&0 &1 \end{bmatrix}\\ \\$

Px,Py就是相机主点坐标，f为焦距，NcNr为像素分辨率

需要注意的是R矩阵是一个正交矩阵，如果打乱旋转的顺序，并不会产生影响，只需要把R矩阵右乘的坐标顺序相应转换就行了：

R=Rx*Ry*Rz:对应的就是[x,y,z]

R=Ry*Rz*Rx:对应的就是[y,z,x]

x,y,z轴分别代表pitch,roll,azimuth

%x,y,z代表对应的角度
Rx=[1 0 0;0 cos(x) sin(x);0 -sin(x) cos(x)];
Ry=[cos(y) 0 -sin(y);0 1 0;sin(y) 0 cos(y)];
Rz=[cos(z) sin(z) 0;-sin(z) cos(z) 0; 0 0 1];

当图像被resize时，外参数不变，K矩阵的前两行才需要乘以一个系数：

世界坐标系，图像坐标系，车体坐标系，雷达坐标系转换相关推荐

雷达坐标系之间的转换
雷达坐标系之间的转换旋转坐标系参考坐标系弹体坐标系天线坐标系波束指向坐标系旋转坐标系 (1)绕x轴旋转 ϕ \phi ϕ,其旋转矩阵为 X ( ϕ ) = [ 1 0 0 0 c o s ...
slam十四讲，第五讲中相机坐标系，像素平面坐标系，世界坐标系，归一化坐标系总结
#笔记,方便日后忘记回看,仅总结,具体推导回看十四讲先上图: 如图,现实世界中有一个P点和一个相机(光心),描述这个P点的空间坐标首先得有一个坐标系,那么以光心为原点O建一个坐标系,叫相机坐标系. ...
经纬度坐标系与UTM MGRS坐标系之间的转换 c# 版本
摘要: 经纬度坐标系与UTM, MGRS坐标系之间的转换代码 c# 原文地址: http://lu.9efish.com/Blog/longitude-latitude-utm-mgrs-csharp ...
(转)从零实现3D图像引擎：(5)3D坐标系函数库
1. 数学分析 1) 2D笛卡尔坐标系与2D极坐标系 2D笛卡尔坐标系就是平面直角坐标系,不说了. 2D极坐标系,是用方向和距离来定义2D空间中的点,而非x,y坐标,如下图: 其中极坐标的参数用红色表 ...
Echarts数据可视化radar雷达坐标系，开发全解+完美注释
全栈工程师开发手册 (作者:栾鹏) Echarts数据可视化开发代码注释全解 Echarts数据可视化开发参数配置全解 6大公共组件详解(点击进入): title详解. tooltip详解.toolb ...
对于SLAM定位中各类坐标系的理解（坐标系，里程计坐标系，基座坐标系与雷达坐标系）
最近系统性学习了一遍LIO-SAM,开始的时候一直搞不懂里程计坐标系,经过不断学习才有了一点自己的拙见. 引言:首先我们搞清楚SLAM算法主要是解决建图与定位问题,其更侧重定位,即让机器人知道自己在全 ...
大疆坐标系和高德地图坐标系之间转换的问题
目前各种坐标系非常多,他们之间的转换就是个比较麻烦的问题.之前有个问题,就是大疆的坐标系在高德地图上显示发生了偏移,但是好在高德地图提供了坐标转换的API,但是新的问题来了,大疆的坐标适应了高德的坐标 ...
WGS84地球坐标系，GCJ02火星坐标系，BD09百度坐标系简介与转换，mybatis字段映射原理
1.各坐标系简介 2.各坐标系转换 2.1坐标点实体类 2.2各坐标系转换工具类 3.测试 1.各坐标系简介 WGS84坐标系即地球坐标系,国际上通用的坐标系. 设备一般包含GPS芯片或者北斗芯片获 ...
GCJ-02火星坐标系、BD-09百度坐标系和WGS-84坐标系转换
WGS-84:GPS坐标系 GCJ-02:火星坐标系,国测局02年发布的坐标体系,高德,腾讯等使用. BD-09:百度坐标系 GCJ-02火星坐标系和WGS-84坐标系转换关系 var pi = 3. ...

世界坐标系，图像坐标系，车体坐标系，雷达坐标系转换

世界坐标系，图像坐标系，车体坐标系，雷达坐标系转换相关推荐

最新文章

热门文章