CN110888123A - 一种基于旋转矩阵的雷达坐标转换方法 - Google Patents
一种基于旋转矩阵的雷达坐标转换方法 Download PDFInfo
- Publication number
- CN110888123A CN110888123A CN201911065058.3A CN201911065058A CN110888123A CN 110888123 A CN110888123 A CN 110888123A CN 201911065058 A CN201911065058 A CN 201911065058A CN 110888123 A CN110888123 A CN 110888123A
- Authority
- CN
- China
- Prior art keywords
- coordinate
- coordinate system
- matrix
- rotation matrix
- rotation
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 239000011159 matrix material Substances 0.000 title claims abstract description 49
- 238000000034 method Methods 0.000 title claims abstract description 20
- 238000006243 chemical reaction Methods 0.000 title claims abstract description 13
- 238000004364 calculation method Methods 0.000 claims abstract description 8
- 230000009466 transformation Effects 0.000 abstract description 12
- 238000004422 calculation algorithm Methods 0.000 abstract description 6
- 238000011426 transformation method Methods 0.000 abstract description 6
- 238000005259 measurement Methods 0.000 description 2
- 230000002441 reversible effect Effects 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 230000001131 transforming effect Effects 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/66—Radar-tracking systems; Analogous systems
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/02—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Image Processing (AREA)
Abstract
本发明公开了一种基于旋转矩阵的雷达坐标转换方法,属于雷达跟踪领域,特别是涉及坐标变换。该方法在三维直角坐标系中,当坐标系以三个坐标轴X、Y、Z为旋转轴旋转一定角度,原坐标系下点的坐标变换到新坐标系下点的坐标可通过对原坐标系分别以X/Y/Z轴为旋转轴进行三次二维旋转得到。该方法提供了基于旋转矩阵的可避免矩阵求逆运算的坐标转换方法。该方法利用旋转矩阵的构造特性,反演出该旋转矩阵对应的逆矩阵,从而在坐标转换时避免进行矩阵的逆运算,一方面提高了逆矩阵的计算精度,另一方面大大降低了算法的运算量。
Description
技术领域
本发明属于雷达跟踪领域,涉及矩阵理论、坐标转换以及旋转矩阵的构造,具体为一种基于旋转矩阵的坐标转换方法。
背景技术
坐标转换是空间实体的位置描述,是从一种坐标系统变换到另一种坐标系统的过程。通过建立两个坐标系统之间一一对应关系来实现。在雷达跟踪探测过程中,其测量结果往往需要转化为大地坐标系下的位置,以便后续各类目标参数的转化与测量。
坐标转换在雷达中是必要的环节,因不同雷达不同的要求而有所不同。在跟踪过程中会出现几种不同定义下的坐标系,其在某雷达中的具体转换步骤及转换公式也不尽相同。(见文献张宁红.坐标转换在雷达实时显示软件中的应用[J].现代雷达,2002(05):30-32.)。
文献(凌震莹.大地坐标系与站心地平直角坐标系的坐标转换[J].声学与电子工程,2009(04):31-34.)中介绍了大地坐标系和站心地平直角坐标系之间的转换算法,并结合实例数据对算法运算精度和速度进行了仿真分析和评价,可解决声呐浮标搜潜系统中实时将测量所得的目标位置信息从大地坐标系转换到作战区域所在的站心地平直角坐标系中问题,供定位和跟踪之用。
文献(曹正才.舰载雷达常用稳定方式坐标变换[J].雷达与对抗,2010,30(01):47-52.)中介绍了舰载雷达常用的坐标变换技术,给出了具体推导过程及各坐标系下天线指向的计算公式,为舰载雷达常用稳定方式的伺服控制及雷达天线指向计算提供理论依据。
上述文献中提出了坐标系的各个概念,对于几种坐标之间的转换方法进行介绍,并进行了论证,可以应用于定位与追踪,不过其中涉及到坐标转换应用的矩阵仍为可逆运算,与本专利提出的坐标变换不一致。
发明内容
本发明的目的在于利用旋转矩阵的构造特性,反演出该旋转矩阵对应的逆矩阵。此方法可在在坐标转换时避免进行矩阵的逆运算,一方面提高了逆矩阵的计算精度,另一方面大大降低了算法的运算量。
为实现上述目的,本发明实现了一种基于旋转矩阵的雷达坐标转换方法,具体包括以下步骤:
计算由三维直角坐标系M下的坐标点A转换到三维直角坐标系N得到坐标点B时;
步骤1:设三维直角坐标系M绕X轴旋转α角度,再绕Y轴旋转β角度,再绕Z轴旋转γ角度后得到三维直角坐标系N;根据已知的三维直角坐标系M和三维直角坐标系N计算出各旋转角度α、β、γ;
步骤2:将坐标点A采用如下公式转换到坐标点B:
B=T×A
步骤3:将坐标点B换到坐标点A时采用如下公式计算:
A=T-1×B
本发明的有益效果为:
提供了基于旋转矩阵的可避免矩阵求逆运算的坐标转换方法。该方法利用旋转矩阵的构造特性,反演出该旋转矩阵对应的逆矩阵,从而在坐标转换时避免进行矩阵的逆运算,一方面提高了逆矩阵的计算精度,另一方面大大降低了算法的运算量。
附图说明
图1为本发明的一种基于旋转矩阵的坐标转换方法的流程图。
图2为二维旋转矩阵构造原理图。
具体实施方式
下面结合说明书附图详细说明本发明的具体实施方式。如图1所示的本发明的一种基于旋转矩阵的坐标转换方法的流程图,其具体包含以下步骤:
步骤1.在三维直角坐标系中,当坐标系以三个坐标轴X、Y、Z为旋转轴旋转一定角度,原坐标系下点的坐标变换到新坐标系下点的坐标可通过对原坐标系分别以X/Y/Z轴为旋转轴进行三次二维旋转得到。
二维旋转变换过程如下,如图2所示,在二维直角坐标系Z-Y中,假设原坐标系中点A的坐标为A=(y,z),由三角函数可知:
坐标系顺时针旋转α后,A点在新坐标系下的坐标为A1=(x',y',z'),有:
由两角和差公式可得:
将A的坐标带入上式可得:
y'=y cos(α)-z sin(α)
z'=z cos(α)+y sin(α)
即:
步骤2.三维直角坐标系分别以X、Y、Z轴旋转α、β、γ,于是根据步骤1和旋转矩阵原理,假设原三维坐标系中点A的坐标为A=(1,1,1),原坐标系以X轴为旋转轴旋转45°后的新坐标值A1=(x',y',z')为
类似的,坐标系以Y轴为旋转轴旋转45°后的新坐标值A2为:
坐标系延Z轴旋转45°后的新坐标值A3为:
可以得出,在三维坐标系中,原坐标系下点的坐标与新坐标系下点的坐标的转换关系为
A3=T×A
其中,
步骤3.构造T矩阵的逆矩阵。由旋转矩阵的构造特性可知,将新坐标系下点的坐标转换为原坐标系下点的坐标,可通过对新坐标系分别以X/Y/Z轴进行三次二维的反向旋转得到。即
新坐标系分别以X、Y、Z轴旋转-45°、-45°、-45°,可得到原坐标系下点的坐标。
由此可以得出,新坐标系转换回原坐标系的转换关系为:
A=T-1×A3
其中,
将A3带入可得
由此可知,构造的矩阵正是旋转矩阵T的逆矩阵。
本发明提供了一种可避免矩阵求逆的快速求解方式,其数学证明如下,根据三角函数公式的性质,化简T-1,即
进一步的,将上诉公式和T矩阵进行矩阵乘法运算,得
根据矩阵运算的交换性得,
故此方法构造出的矩阵为T矩阵的逆矩阵。
由以上仿真结果可知,本发明利用旋转矩阵的构造特性,反演出该旋转矩阵对应的逆矩阵,从而在坐标转换时避免进行矩阵的逆运算,一方面提高了逆矩阵的计算精度,另一方面大大降低了算法的运算量。
以上所述,仅为本发明的具体实施方式,本说明书中所公开的任一特征,除非特别叙述,均可被其他等效或具有类似目的的替代特征加以替换;所公开的所有特征、或所有方法或过程中的步骤,除了互相排斥的特征或步骤以外,均可以任何方式组合。
Claims (1)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911065058.3A CN110888123A (zh) | 2019-11-04 | 2019-11-04 | 一种基于旋转矩阵的雷达坐标转换方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911065058.3A CN110888123A (zh) | 2019-11-04 | 2019-11-04 | 一种基于旋转矩阵的雷达坐标转换方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN110888123A true CN110888123A (zh) | 2020-03-17 |
Family
ID=69746811
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911065058.3A Pending CN110888123A (zh) | 2019-11-04 | 2019-11-04 | 一种基于旋转矩阵的雷达坐标转换方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110888123A (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113091605A (zh) * | 2021-03-18 | 2021-07-09 | 中国电子科技集团公司第十一研究所 | 一种对光电系统的标定方法及计算机可读存储介质 |
CN116755143A (zh) * | 2023-06-12 | 2023-09-15 | 中国矿业大学 | 基于微震系统探测概率的矿山微震能量-频次补偿方法 |
-
2019
- 2019-11-04 CN CN201911065058.3A patent/CN110888123A/zh active Pending
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113091605A (zh) * | 2021-03-18 | 2021-07-09 | 中国电子科技集团公司第十一研究所 | 一种对光电系统的标定方法及计算机可读存储介质 |
CN116755143A (zh) * | 2023-06-12 | 2023-09-15 | 中国矿业大学 | 基于微震系统探测概率的矿山微震能量-频次补偿方法 |
CN116755143B (zh) * | 2023-06-12 | 2023-11-07 | 中国矿业大学 | 基于微震系统探测概率的矿山微震能量-频次补偿方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107239076B (zh) | 基于虚拟扫描与测距匹配的agv激光slam方法 | |
CN103197317B (zh) | 基于fpga的sar成像方法 | |
CN108759665B (zh) | 一种基于坐标转换的空间目标三维重建精度分析方法 | |
CN108318880B (zh) | 一种运动误差参数化的极坐标sar成像方法 | |
CN106324597B (zh) | 基于pfa的大转角isar雷达的平动补偿和成像方法 | |
CN104035083B (zh) | 一种基于量测转换的雷达目标跟踪方法 | |
CN110142805A (zh) | 一种基于激光雷达的机器人末端校准方法 | |
CN106772290B (zh) | 一种全极化双基地雷达目标动态回波模拟方法 | |
CN110503713B (zh) | 一种基于轨迹平面法向量和圆心结合的旋转轴估计方法 | |
CN106845037B (zh) | 一种五自由度串联机器人的逆运动学通用求解方法 | |
CN109471101A (zh) | 一种弹载sar图像校正方法 | |
CN104932535A (zh) | 利用仿真系统对机载前视红外搜索设备闭环测试的方法 | |
CN110888123A (zh) | 一种基于旋转矩阵的雷达坐标转换方法 | |
CN111123280A (zh) | 激光雷达的定位方法、装置、系统、电子设备及存储介质 | |
CN113238072B (zh) | 一种适用于车载光电平台的运动目标解算方法 | |
CN103810746A (zh) | 一种渲染任意方位3d模型的方法及装置 | |
CN111460071A (zh) | 高精地图的偏转方法、装置、设备及可读存储介质 | |
CN110596653A (zh) | 一种多雷达数据融合方法及装置 | |
CN114942431A (zh) | 光雷同步观测的空间目标瞬时姿态估计方法 | |
CN109599674A (zh) | 一种基于解耦的相控阵天线稳定角跟踪方法 | |
CN110879924A (zh) | 一种数字相控阵天线的建模与仿真方法 | |
CN102445692B (zh) | 基于二维图像声纳的水下运动目标位置测定方法 | |
CN108469612A (zh) | 基于等效斜距的双基时变加速度前视sar成像方法 | |
CN108828509B (zh) | 一种多平台多辐射源承载关系判定方法 | |
CN111127334A (zh) | 基于rd平面像素映射的sar图像实时几何校正方法及系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20200317 |
|
RJ01 | Rejection of invention patent application after publication |