传感器_雷达坐标系到转台坐标系的转换

本文记录一种雷达坐标系到转台坐标系的转换方法。

已知条件:

目标在雷达-极坐标系的坐标为 ( θ A , θ E , d ) \left( {{\theta }{A}},{{\theta }{E}},d \right) (θA,θE,d),其中 θ A {\theta }{A} θA为目标的方位角, θ E {\theta }{E} θE为目标的俯仰角, d d d为目标到雷达坐标系原点 O 雷达 O_{雷达} O雷达的距离。

求解:

目标在转台-极坐标系的坐标?

1、根据已知条件,可以先求解获得目标在雷达-东北天-三维垂直坐标系的坐标。
z 雷达 = d ⋅ sin ⁡ ( θ E ) x 雷达 = d ⋅ cos ⁡ ( θ E ) ⋅ cos ⁡ ( θ A ) y 雷达 = d ⋅ cos ⁡ ( θ E ) ⋅ sin ⁡ ( θ A ) \begin{array}{l} z_{雷达} = d \cdot \sin \left( {{\theta E}} \right)\\ x{雷达} = d \cdot \cos \left( {{\theta _E}} \right) \cdot \cos \left( {{\theta A}} \right)\\ y{雷达} = d \cdot \cos \left( {{\theta _E}} \right) \cdot \sin \left( {{\theta _A}} \right) \end{array} z雷达=d⋅sin(θE)x雷达=d⋅cos(θE)⋅cos(θA)y雷达=d⋅cos(θE)⋅sin(θA)

2、通过实际测量的方式,测量雷达坐标系原点 O 雷达 O_{雷达} O雷达在转台 -东北天-三维垂直坐标系上的坐标。

Δ x Δ y Δ z \] \\left\[ \\begin{array}{l} \\Delta x\\\\ \\Delta y\\\\ \\Delta z \\end{array} \\right\] ΔxΔyΔz 3、根据第1步获得的目标在雷达-东北天-三维垂直坐标系的坐标,以及第2步通过实际测量获得的雷达坐标原点 O 雷达 O_{雷达} O雷达在**转台** -东北天-三维垂直坐标系上的坐标,可以得到目标,在**转台** -东北天-三维垂直坐标系上坐标。 x 转台 = x 雷达 + Δ x = Δ x + d ⋅ cos ⁡ ( θ E ) ⋅ cos ⁡ ( θ A ) y 转台 = y 雷达 + Δ y = Δ y + d ⋅ cos ⁡ ( θ E ) ⋅ sin ⁡ ( θ A ) z 转台 = z 雷达 + Δ z = Δ z + d ⋅ sin ⁡ ( θ E ) \\begin{array}{l} {x_{转台}} = {x_{雷达}} + \\Delta x = \\Delta x + d \\cdot \\cos \\left( {{\\theta _E}} \\right) \\cdot \\cos \\left( {{\\theta _A}} \\right)\\\\ {y_{转台}} = {y_{雷达}} + \\Delta y = \\Delta y + d \\cdot \\cos \\left( {{\\theta _E}} \\right) \\cdot \\sin \\left( {{\\theta _A}} \\right)\\\\ {z_{转台}} = {z_{雷达}} + \\Delta z = \\Delta z + d \\cdot \\sin \\left( {{\\theta _E}} \\right) \\end{array} x转台=x雷达+Δx=Δx+d⋅cos(θE)⋅cos(θA)y转台=y雷达+Δy=Δy+d⋅cos(θE)⋅sin(θA)z转台=z雷达+Δz=Δz+d⋅sin(θE) 4、根据第3步获得的目标在转台-东北天-三维垂直坐标系的坐标,可以计算目标在转台-极坐标系的坐标。 θ ′ A = arctan ⁡ ( y 转台 x 转台 ) = arctan ⁡ ( Δ y + d ⋅ cos ⁡ ( θ E ) ⋅ sin ⁡ ( θ A ) Δ x + d ⋅ cos ⁡ ( θ E ) ⋅ cos ⁡ ( θ A ) ) θ ′ E = arctan ⁡ ( z 转台 x 转台 2 + y 转台 2 ) = arctan ⁡ ( Δ z + d ⋅ sin ⁡ ( θ E ) ( Δ x + d ⋅ cos ⁡ ( θ E ) ⋅ cos ⁡ ( θ A ) ) 2 + ( Δ y + d ⋅ cos ⁡ ( θ E ) ⋅ sin ⁡ ( θ A ) ) 2 ) d ′ = x 转台 2 + y 转台 2 + z 转台 2 = ( Δ x + d ⋅ cos ⁡ ( θ E ) ⋅ cos ⁡ ( θ A ) ) 2 + ( Δ y + d ⋅ cos ⁡ ( θ E ) ⋅ sin ⁡ ( θ A ) ) 2 + ( Δ z + d ⋅ sin ⁡ ( θ E ) ) 2 \\begin{array}{l} {{\\theta '}_A} = \\arctan \\left( {\\frac{{{y_{转台}}}}{{{x_{转台}}}}} \\right) = \\arctan \\left( {\\frac{{\\Delta y + d \\cdot \\cos \\left( {{\\theta _E}} \\right) \\cdot \\sin \\left( {{\\theta _A}} \\right)}}{{\\Delta x + d \\cdot \\cos \\left( {{\\theta _E}} \\right) \\cdot \\cos \\left( {{\\theta _A}} \\right)}}} \\right)\\\\ {{\\theta '}_E} = \\arctan \\left( {\\frac{{{z_{转台}}}}{{\\sqrt {x_{转台}\^2 + y_{转台}\^2} }}} \\right)\\\\ = \\arctan \\left( {\\frac{{\\Delta z + d \\cdot \\sin \\left( {{\\theta _E}} \\right)}}{{\\sqrt {{{\\left( {\\Delta x + d \\cdot \\cos \\left( {{\\theta _E}} \\right) \\cdot \\cos \\left( {{\\theta _A}} \\right)} \\right)}\^2} + {{\\left( {\\Delta y + d \\cdot \\cos \\left( {{\\theta _E}} \\right) \\cdot \\sin \\left( {{\\theta _A}} \\right)} \\right)}\^2}} }}} \\right)\\\\ d' = \\sqrt {x_{转台}\^2 + y_{转台}\^2 + z_{转台}\^2} \\\\ = \\sqrt {{{\\left( {\\Delta x + d \\cdot \\cos \\left( {{\\theta _E}} \\right) \\cdot \\cos \\left( {{\\theta _A}} \\right)} \\right)}\^2} + {{\\left( {\\Delta y + d \\cdot \\cos \\left( {{\\theta _E}} \\right) \\cdot \\sin \\left( {{\\theta _A}} \\right)} \\right)}\^2} + {{\\left( {\\Delta z + d \\cdot \\sin \\left( {{\\theta _E}} \\right)} \\right)}\^2}} \\end{array} θ′A=arctan(x转台y转台)=arctan(Δx+d⋅cos(θE)⋅cos(θA)Δy+d⋅cos(θE)⋅sin(θA))θ′E=arctan(x转台2+y转台2 z转台)=arctan((Δx+d⋅cos(θE)⋅cos(θA))2+(Δy+d⋅cos(θE)⋅sin(θA))2 Δz+d⋅sin(θE))d′=x转台2+y转台2+z转台2 =(Δx+d⋅cos(θE)⋅cos(θA))2+(Δy+d⋅cos(θE)⋅sin(θA))2+(Δz+d⋅sin(θE))2 > 补充说明:东北天三维坐标系,指的是正东方向、正北方向、天空方向三个方向所构成的大地坐标系。雷达所获得目标的极坐标,**未必是基于东北天三维坐标系的**,比如是北(x)西(y)天(z)。那么我们在实现第2步到时候,则需要以雷达的坐标系为准,来定义转台的大地坐标系。 测量雷达坐标系原点,在北(x)西(y)天(z)三个方向上在转台坐标系的坐标。 获得了目标在转台的极坐标之后,可以进一步进行标定, 即转台转到 计算得到目标在转台极坐标系的角度 位置。 看目标是否进入转台的图像视场(中心)当中, 如果没有进入,则进一步添加一定的偏置量,使目标进入转台的图像视场(中心)当中。 在以后的坐标系转换工作当中,就直接将标定的偏置量加入其中。

相关推荐
腾恩科技2 天前
光电传感器:机器人大战中的隐形指挥官
传感器·光电传感器
brave and determined5 天前
传感器学习(day04):红外感知:从经典热释电开关到智能时代的隐形慧眼
嵌入式硬件·算法·传感器·红外·嵌入式设计·红外矩阵·人体红外
谈思汽车5 天前
索尼撬动SerDes市场,汽车芯片进入“集成化”赛段!
汽车·serdes·传感器·汽车芯片
moonquakeTT7 天前
雷达调试5大核心思路:从理论到实战
人工智能·matlab·目标跟踪·雷达
爱看书的小沐7 天前
【小沐学WebGIS】基于Cesium.JS绘制雷达波束/几何体/传感器Sensor(Cesium / vue / react )
javascript·vue.js·react.js·雷达·cesium·传感器·波束
北京盛世宏博10 天前
双供电 + 一级防雷!通讯机房专用以太网温湿度传感器,24 小时不中断监测
传感器·温湿度·变送器·poe 供电
brave and determined11 天前
传感器学习(day02)毫米波雷达:重塑人机交互新维度
单片机·嵌入式硬件·嵌入式·人机交互·传感器·毫米波·嵌入式设计
wtsolutions12 天前
JSON转Excel工具新增WPS插件功能,将JSON转换成WPS表格工作表数据
json·excel·wps·插件·转换·加载项·wtsolutions
wtsolutions13 天前
Excel to JSON by WTSolutions 4.0.0 版本更新公告
json·excel·wps·插件·转换·加载项·wtsolutions
Evand J13 天前
【MATLAB雷达滤波代码】二维,单雷达跟踪与滤波。EKF融合雷达的距离、角度+目标IMU数据。附代码下载链接
开发语言·matlab·雷达·ekf·雷达跟踪·角度观测