CN114167900A - 一种基于无人机和差分gps的光电跟踪系统标校方法及装置 - Google Patents
一种基于无人机和差分gps的光电跟踪系统标校方法及装置 Download PDFInfo
- Publication number
- CN114167900A CN114167900A CN202111400335.9A CN202111400335A CN114167900A CN 114167900 A CN114167900 A CN 114167900A CN 202111400335 A CN202111400335 A CN 202111400335A CN 114167900 A CN114167900 A CN 114167900A
- Authority
- CN
- China
- Prior art keywords
- calibration
- coordinate system
- photoelectric tracking
- actual
- point
- 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.)
- Granted
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D3/00—Control of position or direction
- G05D3/12—Control of position or direction using feedback
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明涉及一种基于无人机和差分GPS的光电跟踪系统标校方法及装置,利用差分GPS采集光电跟踪系统以及任意两个标校点在地理坐标系下的部署点坐标信息;再通过光电跟踪系统分别测量两个标校点在光电跟踪坐标系下的标校点测量坐标信息;根据部署点坐标信息、两个标校点实际坐标信息和两个标校点测量坐标信息,计算出光电跟踪坐标系相对于地理坐标系的方位角、俯仰角和横滚角;基于方位角、俯仰角和横滚角,得到光电跟踪坐标系相对于地理坐标系的旋转矩阵;该旋转矩阵可以用于进行标校补偿。本发明实现了对光电跟踪系统的快速、高精度标校。
Description
技术领域
本发明涉及一种基于无人机和差分GPS的光电跟踪系统标校方法及装置,属于光电技术领域。
背景技术
光电跟踪系统常用于精确定位和制导,因此常需要光电跟踪系统具有很高的标校精度,以尽可能减小系统误差。
光电跟踪系统常规标校过程中,首先使用手动或自动设备将底座调平,保证主传感器在水平平面内,然后再修正转台方位角进行校北。调平时需要通过水平仪测定不同方向水平情况,并反复调整支撑腿,中间过程操作繁琐,且精度不易保证;校北时为保证精度一般需要在远处地面设置多个标校点,标校点之间尽可能保持方位偏差较大,随之带来地面人员、设备转移困难。
发明内容
本发明的主要目的是提供一种基于无人机和差分GPS的光电跟踪系统标校方法及装置,标校点的测量过程比较简单,而且计算得到标校误差后无需进行多次的硬件调平和校北,在软件中通过旋转矩阵进行实时的标校补偿,解决以往光电跟踪系统常规标定过程中操作繁琐、过程复杂和精度较低的问题。
为了解决上述技术问题,本发明提供了一种基于无人机和差分GPS的光电跟踪系统标校方法,包括:
步骤一,利用差分GPS采集光电跟踪系统在地理坐标系下的部署点坐标信息;
步骤二,将所述差分GPS挂载于旋翼无人机,利用所述旋翼无人机任意选择两个标校点,并利用所述差分GPS分别测定两个所述标校点在所述地理坐标系下的标校点实际坐标信息;
步骤三,通过所述光电跟踪系统分别测量两个所述标校点在光电跟踪坐标系下的标校点测量坐标信息;
步骤四,根据所述部署点坐标信息、两个所述标校点实际坐标信息和两个所述标校点测量坐标信息,计算出所述光电跟踪坐标系相对于所述地理坐标系的方位角、俯仰角和横滚角;
步骤五,基于所述方位角、所述俯仰角和所述横滚角,得到所述光电跟踪坐标系相对于所述地理坐标系的旋转矩阵;其中,所述旋转矩阵用于进行实时的标校补偿。
可选地,所述地理坐标系以地球正北方向为OX轴、以地球正东方向为OY轴、以垂直于地球表面向上为OZ轴。
可选地,所述光电跟踪坐标系以所述光电跟踪系统平面内伺服方位零位方向且垂直于俯仰零位平面为OX1轴、以所述光电跟踪系统平面内伺服俯仰零位方向且垂直于方位零位平面为OY1轴、以垂直于X1OY1平面向上为OZ1轴;
可选地,所述部署点坐标信息包括部署点在所述地理坐标系下的部署点经度、部署点纬度和部署点高度;所述标校点实际坐标信息包括所述标校点在所述地理坐标系下的实际方位、实际俯仰、实际距离;所述标校点测量坐标信息包括所述标校点在所述光电跟踪坐标系下的测量方位、测量俯仰和测量距离。
可选地,步骤四包括:
根据所述部署点的部署点经度、部署点纬度、部署点高度和两个所述标校点的实际方位、实际俯仰、实际距离,计算出所述标校点在所述地理坐标系下相对于所述部署点的相对方位、相对俯仰和相对距离;
根据两个所述标校点相对于所述部署点的相对方位、相对俯仰和相对距离,以及两个所述标校点的测量方位、测量俯仰和测量距离,计算出所述光电跟踪坐标系相对于所述地理坐标系的方位角、俯仰角和横滚角。
可选地,采用如下公式计算所述旋转矩阵:
其中,α是所述方位角、β是所述俯仰角和γ是所述横滚角,Pα是OX1轴的旋转矩阵,Pβ是OY1轴的旋转矩阵,Pγ是OZ1轴的旋转矩阵。
可选地,所述旋转矩阵用于将目标在所述光电跟踪坐标系下测得的目标测量坐标信息转换为在所述地理坐标系下的目标实际坐标信息。
可选地,按如下公式将目标在所述光电跟踪坐标系下测得的所述目标测量坐标信息转换为在所述地理坐标系下的所述目标实际坐标信息:
Aj=arcsin[sinγcosAisin(Ei-α)-cosγsinβcosAicos(Ei-α)+cosβcosγsinAi],
Rj=Ri;
其中,所述目标实际坐标信息包括目标实际方位Aj、目标实际俯仰Ej和目标实际距离Rj,所述目标测量坐标信息包括目标测量方位Ai、目标测量俯仰Ei和目标测量距离Ri。
可选地,两个所述标校点位于,以所述光电跟踪系统为圆心、以所述旋翼无人机飞行限制距离为半径的范围内。
为了解决上述技术问题,本发明还提供了一种一种基于无人机和差分GPS的光电跟踪系统标校装置,包括光电跟踪系统、旋翼无人机和差分GPS;其中,所述光电跟踪系统包括红外热像仪、可见光摄像机、激光测距机、伺服转台、伺服控制组合、通信组合和后端显控设备;所述差分GPS为独立供电且离线存储定位数据;
所述差分GPS用于采集所述光电跟踪系统在地理坐标系下的部署点坐标信息、以及分别测定两个标校点在所述地理坐标系下的标校点实际坐标信息,并存储所述部署点坐标信息和所述标校点实际坐标信息;其中,所述地理坐标系以地球正北方向为OX轴、以地球正东方向为OY轴、以垂直于地球表面向上为OZ轴;所述部署点坐标信息包括部署点在所述地理坐标系下的部署点经度、部署点纬度和部署点高度;所述标校点实际坐标信息包括所述标校点在所述地理坐标系下的实际方位、实际俯仰、实际距离;
所述旋翼无人机用于挂载所述差分GPS、以及悬停在任意选择的两个所述标校点;
所述红外热像仪和所述可见光摄像机用于采集所述旋翼无人机的图像;所述伺服控制组合用于调整所述红外热像仪和所述可见光摄像机的角度,以将所述旋翼无人机保持在图像中心位置;
所述伺服转台用于读取目标或所述标校点的测量方位和测量俯仰;所述激光测距机用于获得所述目标与所述部署点之间的测量距离;其中,标校点测量坐标信息包括所述标校点在光电跟踪坐标系下的测量方位、测量俯仰和测量距离;所述光电跟踪坐标系以所述光电跟踪系统平面内伺服方位零位方向且垂直于俯仰零位平面为OX1轴、以所述光电跟踪系统平面内伺服俯仰零位方向且垂直于方位零位平面为OY1轴、以垂直于X1OY1平面向上为OZ1轴;
所述通信组合用于所述后端显控设备、所述红外热像仪、所述可见光摄像机、所述激光测距机、所述伺服转台、所述伺服控制组合之间的通信,以及传输图像、状态信息、控制指令和所述标校点测量坐标信息;
所述后端显控设备用于,对所述红外热像仪、所述可见光摄像机、所述激光测距机、所述伺服转台、所述伺服控制组合的控制;图像显示、状态显示和实时标校补偿;根据所述部署点坐标信息、两个所述标校点实际坐标信息和两个所述标校点测量坐标信息,计算出所述光电跟踪坐标系相对于所述地理坐标系的方位角、俯仰角和横滚角;以及,基于所述方位角、所述俯仰角和所述横滚角,得到所述光电跟踪坐标系相对于所述地理坐标系的旋转矩阵;其中,所述旋转矩阵用于进行实时的标校补偿。
可选地,两个所述标校点位于,以光电跟踪系统为圆心、以旋翼无人机飞行限制距离为半径的半球范围内。
可选地,所述后端显控设备进一步用于:
根据所述部署点的部署点经度、部署点纬度、部署点高度和两个所述标校点的实际方位、实际俯仰、实际距离,计算出所述标校点在所述地理坐标系下相对于所述部署点的相对方位、相对俯仰和相对距离;
根据两个所述标校点相对于所述部署点的相对方位、相对俯仰和相对距离,以及两个所述标校点的测量方位、测量俯仰和测量距离,计算出所述光电跟踪坐标系相对于所述地理坐标系的方位角、俯仰角和横滚角;
以及,采用如下公式计算所述旋转矩阵:
其中,α是所述方位角、β是所述俯仰角和γ是所述横滚角,Pα是OX1轴的旋转矩阵,Pβ是OY1轴的旋转矩阵,Pγ是OZ1轴的旋转矩阵。
可选地,所述后端显控设备还用于:按如下步骤将所述目标在所述光电跟踪坐标系下测得的目标测量坐标信息转换为在所述地理坐标系下的目标实际坐标信息:
Aj=arcsin[sinγcosAisin(Ei-α)-cosγsinβcosAicos(Ei-α)+cosβcosγsinAi],
Rj=Ri;
其中,所述目标实际坐标信息包括目标实际方位Aj、目标实际俯仰Ej和目标实际距离Rj,所述目标测量坐标信息包括目标测量方位Ai、目标测量俯仰Ei和目标测量距离Ri。
实施本发明的一种基于无人机和差分GPS的光电跟踪系统标校方法及装置,具有以下有益效果:
采用挂载高精度差分GPS的无人机在不同方位、俯仰和距离上静态测定多个标校点,获取标校点经度、维度和高度信息,同时光电跟踪系统将主传感器中心对准标校点,获取各标校点方位、俯仰和距离信息,任选两个标校点和设备部署点计算出当前光电跟踪系统姿态(方位角、俯仰角和横滚角),获取一次标校后,通过旋转矩阵补偿可获取目标实际方位、俯仰和距离信息,无须进行反复的基座调平、方位校北和标校验证工作。上述技术方案解决了以往光电跟踪系统标校过程中调平、校北过程繁琐和精度不高的问题。
附图说明
图1是本发明实施例的一种基于无人机和差分GPS的光电跟踪系统标校方法的示意图;
图2是本发明实施例的坐标系示意图;
图3是根据本发明一个可参考实施例的一种基于无人机和差分GPS的光电跟踪系统标校方法的主要流程的示意图;
图4是本发明实施例的一种基于无人机和差分GPS的光电跟踪系统标校装置的示意图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明的一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动的前提下所获得的所有其他实施例,都属于本发明保护的范围。
如图1所示,本发明实施例的一种基于无人机和差分GPS的光电跟踪系统标校方法,主要包括如下步骤:
步骤一,利用差分GPS采集光电跟踪系统在地理坐标系下的部署点坐标信息。差分GPS(differential GPS-DGPS,DGPS)是首先利用已知精确三维坐标的差分GPS基准台,求得伪距修正量或位置修正量,再将这个修正量实时或事后发送给用户(GPS导航仪),对用户的测量数据进行修正,以提高GPS(全球定位系统)定位精度。参考图2,地理坐标系以地球正北方向为OX轴、以地球正东方向为OY轴、以垂直于地球表面向上为OZ轴。地理坐标系是以光电跟踪系统(部署点)为零点的坐标系。本发明实施例以光电跟踪系统作为部署点,以差分GPS采集地理坐标系下光电跟踪系统的部署点坐标信息,其中,部署点坐标信息包括部署点在地理坐标系下的部署点经度、部署点纬度和部署点高度。
步骤二,将差分GPS挂载于旋翼无人机,利用旋翼无人机任意选择两个标校点,并利用差分GPS分别测定两个标校点在地理坐标系下的标校点实际坐标信息。本发明实施例以任意选择的两个位置作为标校点,并通过旋翼无人机挂载差分GPS的方式分别测定地理坐标系下两个标校点的标校点实际坐标信息,其中,标校点实际坐标信息包括标校点在地理坐标系下的实际方位、实际俯仰、实际距离。需要说明的是,标校点的位置可以通过控制旋翼无人机在任意位置悬停来确定,且两个标校点均位于以光电跟踪系统为圆心、以旋翼无人机飞行限制距离为半径的范围内。
步骤三,通过光电跟踪系统分别测量两个标校点在光电跟踪坐标系下的标校点测量坐标信息。参考图2,光电跟踪坐标系以光电跟踪系统平面内伺服方位零位方向且垂直于俯仰零位平面为OX1轴、以光电跟踪系统平面内伺服俯仰零位方向且垂直于方位零位平面为OY1轴、以垂直于X1OY1平面向上为OZ1轴,光电跟踪坐标系也是以光电跟踪系统(部署点)为零点的坐标系。通过光电跟踪系统测量标校点的坐标时,以光电跟踪坐标系表示标校点的坐标。其中,标校点测量坐标信息包括标校点在光电跟踪坐标系下的测量方位、测量俯仰和测量距离。
步骤四,根据部署点坐标信息、两个标校点实际坐标信息和两个标校点测量坐标信息,计算出光电跟踪坐标系相对于地理坐标系的方位角、俯仰角和横滚角。在获得部署点坐标信息、标校点实际坐标信息和标校点测量坐标信息后,便可以进一步计算光电跟踪坐标系相对于地理坐标系的方位角、俯仰角和横滚角,即光电跟踪坐标系(坐标系O-X1Y1Z1)沿OZ轴旋转方位角、沿OY轴旋转俯仰角、沿OX轴旋转横滚角可得到地理坐标系(坐标系O-XYZ)。
对于方位角、俯仰角和横滚角的计算,可以用前述步骤得到的部署点和标校点的经度、纬度、高度分别计算得出。在本发明实施例中,步骤四可以采用如下方式实现:根据部署点的部署点经度、纬度、高度和两个标校点的实际方位、纬度、高度,计算出标校点在地理坐标系下相对于部署点的相对方位、俯仰和距离;根据两个标校点在地理坐标系和光电跟踪坐标系下的方位、俯仰和距离,计算出光电跟踪坐标系相对于地理坐标系的方位角、俯仰角和横滚角。
步骤五,基于方位角、俯仰角和横滚角,得到光电跟踪坐标系相对于地理坐标系的旋转矩阵。利用上一步计算出的光电跟踪坐标系相对于地理坐标系的方位角、俯仰角和横滚角,可以进一步得到光电跟踪坐标系相对于地理坐标系的旋转矩阵,该旋转矩阵可以用于进行标校补偿。
在本发明实施例中,旋转矩阵可以具体用于将目标在光电跟踪坐标系下测得的目标测量坐标信息转换为在地理坐标系下的目标实际坐标信息。可以采用如下公式计算旋转矩阵:
其中,α表示方位角,β表示俯仰角,γ表示横滚角,Pα表示OX1轴的旋转矩阵,Pβ表示OY1轴的旋转矩阵,Pγ表示OZ1轴的旋转矩阵。
此外,本发明实施例的一种基于无人机和差分GPS的光电跟踪系统标校方法,还可以包括步骤六,在后端显控设备中通过旋转矩阵对目标在地理坐标系下的实际位置进行实时补偿,无须进行反复基座调平、方位校北和标校验证工作。
在得到旋转矩阵后光电跟踪系统便可以用于实际测量,具体地,光电跟踪系统测得目标在光电跟踪坐标系下的目标测量坐标信息后,利用旋转矩阵进行计算即可得到目标在地理坐标系下的目标实际坐标信息。可以按如下公式将目标在光电跟踪坐标系下测得的目标测量坐标信息转换为在地理坐标系下的目标实际坐标信息:
Aj=arcsin[sinγcosAisin(Ei-α)-cosγsinβcosAicos(Ei-α)+cosβcosγsinAi]
Rj=Ri
其中,目标在地理坐标系下的目标实际坐标信息包括目标实际方位Aj、目标实际俯仰Ej和目标实际距离Rj,目标在光电跟踪坐标系下的目标测量坐标信息包括目标测量方位Ai、目标测量俯仰Ei和目标测量距离Ri。
如图3所示,作为一种可参考的实施方式,本发明实施例的一种基于无人机和差分GPS的光电跟踪系统标校方法,可以采用如下方式实施:
首先,设备部署
包括光电跟踪系统、旋翼无人机和差分GPS的组建及连接,建立地理坐标系。
光电跟踪系统由红外热像仪、可见光摄像机、激光测距机、伺服转台、伺服控制组合、通信组合和后端显控设备组成;其中,旋翼无人机优选四旋翼无人机,例如大疆精灵4pro;差分GPS要求具备体积小、重量轻、独立供电、离线存储定位数据等特点,便于挂载在旋翼无人机上,可选用Unistrong G659高精度手持机。
此外,上述设备的操作,最多需要两名人员配合即可完成,具体地,一名人员操作光电跟踪系统,一名人员作为操作旋翼无人机。
地理坐标系是建立在地球表面上的,OX轴为地球正北方向,OY轴为地球正东方向,OZ为垂直于地球表面向上。
在完成以上组建之后建立光电跟踪坐标系,光电跟踪坐标系是建立在光电跟踪系统内,OX1轴为光电跟踪系统平面内伺服方位零位方向且垂直于俯仰零位平面,OY1轴为光电跟踪系统平面内伺服俯仰零位方向且垂直于方位零位平面,OZ1轴为垂直于X1OY1平面向上。
其次,部署点测量
以光电跟踪系统作为部署点,使用差分GPS采集光电跟踪系统的部署点经度、纬度、高度信息,即采集部署点坐标信息。
同时,标校点测量
旋翼无人机在不同方位、俯仰和距离选择两个标校点。然后通过其上挂载的差分GPS测定标校点的真实经度、纬度、高度信息,即测定标校点实际坐标信息。再通过光电跟踪系统测量两个标校点的方位、俯仰、距离信息,即测量标校点测量坐标信息。
然后,光电跟踪坐标系计算
通过部署点坐标信息、以及两个标校点的标校点实际坐标信息和标校点测量坐标信息,计算出光电跟踪坐标系相对于地理坐标系的方位角、俯仰角和横滚角。
最后,旋转矩阵计算
计算倾斜平面坐标系相对于地理坐标系的旋转矩阵。
光电跟踪坐标系下测得的方位、俯仰、距离(即标校点测量坐标信息),通过旋转矩阵计算后,得到标校点在地理坐标系下的方位、俯仰、距离(即标校点实际坐标信息)。
通过上述实施例的说明可以发现,针对现有光电跟踪系统标校方法操作繁琐、过程复杂和精度较低等问题,本发明实施例的一种基于无人机和差分GPS的光电跟踪系统标校方法,采用无人机挂载差分GPS确保无人机操作手在部署点即可完成对360°、旋翼无人机飞行限制距离(例如5km)范围内任意的标校点进行测定;通过旋转矩阵实现对光电跟踪系统倾斜平面的补偿,无须再对光电跟踪系统进行调平、校北工作;当基于计算机软件进行标校时,整个标校过程操作简单,仅需无人机选择两个标校点,通过差分GPS获取真实值,通过光电跟踪系统获取测量值,将真实值和测量值填入计算机软件中,计算机软件自动计算出旋转矩阵并在后续实际使用过程中进行实时补偿,输出相对于地理坐标系的真实值。
如图4所示,本发明实施例的一种基于无人机和差分GPS的光电跟踪系统标校装置,主要包括光电跟踪系统、旋翼无人机和差分GPS。其中,光电跟踪系统包括红外热像仪、可见光摄像机、激光测距机、伺服转台、伺服控制组合、通信组合和后端显控设备。
差分GPS为独立供电且离线存储定位数据,且具备体积小和重量轻等特点,便于挂载在旋翼无人机上。差分GPS用于采集光电跟踪系统在地理坐标系下的部署点坐标信息、以及分别测定两个标校点在地理坐标系下的标校点实际坐标信息,并存储部署点坐标信息和标校点实际坐标信息。其中,地理坐标系以地球正北方向为OX轴、以地球正东方向为OY轴、以垂直于地球表面向上为OZ轴;部署点坐标信息包括部署点在地理坐标系下的部署点经度、部署点纬度和部署点高度;标校点实际坐标信息包括标校点在地理坐标系下的实际方位、实际俯仰、实际距离。
旋翼无人机用于挂载差分GPS、以及悬停在任意选择的两个标校点。需要说明的是,标校点的位置可以通过控制旋翼无人机在任意位置悬停来确定,且两个标校点均位于,以光电跟踪系统为圆心、以旋翼无人机飞行限制距离为半径的范围内。
红外热像仪和可见光摄像机用于采集旋翼无人机的图像;伺服控制组合用于调整红外热像仪和可见光摄像机的角度,以将旋翼无人机保持在图像中心位置。在通过红外热像仪和可见光摄像机采集旋翼无人机的图像时,需要将旋翼无人机保持在图像中心位置,可以通过伺服控制组合调整红外热像仪和可见光摄像机的角度,从而使悬停的旋翼无人机保持在图像中心位置。
伺服转台用于读取目标或标校点的测量方位角和测量俯仰角;激光测距机用于获得目标或标校点和部署点之间的距离。目标或标校点的坐标测量,可以通过伺服转台和激光测距机获取的方位、俯仰和距离信息,结合部署点经度、部署点纬度和部署点高度,进行换算进而得到目标或标校点的测量方位、测量俯仰和测量距离。其中,光电跟踪坐标系以光电跟踪系统平面内伺服方位零位方向且垂直于俯仰零位平面为OX1轴、以光电跟踪系统平面内伺服俯仰零位方向且垂直于方位零位平面为OY1轴、以垂直于X1OY1平面向上为OZ1轴;标校点测量坐标信息包括标校点在光电跟踪坐标系下的测量方位、测量俯仰和测量距离。
通信组合用于后端显控设备和红外热像仪、可见光摄像机、激光测距机、伺服转台、伺服控制组合之间的通信,以及传输图像、状态信息、控制指令和标校点测量坐标信息。
后端显控设备用于对红外热像仪、可见光摄像机、激光测距机、伺服转台、伺服控制组合的控制、图像显示、状态显示和实时标校补偿,根据部署点坐标信息、两个标校点实际坐标信息和两个标校点测量坐标信息,计算出光电跟踪坐标系相对于地理坐标系的方位角、俯仰角和横滚角;以及,基于方位角、俯仰角和横滚角,得到光电跟踪坐标系相对于地理坐标系的旋转矩阵。其中,旋转矩阵用于进行实时的标校补偿。
作为一种优选的实施方式,后端显控设备可以进一步用于以下几项:
一、根据部署点的部署点经度和两个标校点的实际方位,计算出标校点在地理坐标系下相对于部署点的相对方位;根据部署点的部署点纬度和两个标校点的实际俯仰,计算出标校点在地理坐标系下相对于部署点的相对俯仰;根据部署点的部署点高度和两个标校点的实际距离,计算出标校点在地理坐标系下相对于部署点的相对距离;根据相对方位和两个标校点的测量方位,计算出光电跟踪坐标系相对于地理坐标系的方位角;根据相对俯仰和两个标校点的测量俯仰,计算出光电跟踪坐标系相对于地理坐标系的俯仰角;根据相对距离和两个标校点的测量距离,计算出光电跟踪坐标系相对于地理坐标系的横滚角。
二、采用如下公式计算旋转矩阵:
其中,α是方位角、β是俯仰角和γ是横滚角,Pα是OX1轴的旋转矩阵,Pβ是OY1轴的旋转矩阵,Pγ是OZ1轴的旋转矩阵。
三、按如下步骤将目标在光电跟踪坐标系下测得的目标测量坐标信息转换为在地理坐标系下的目标实际坐标信息:
Aj=arcsin[sinγcosAisin(Ei-α)-cosγsinβcosAicos(Ei-α)+cosβcosγsinAi],
Rj=Ri;
其中,目标在地理坐标系下的目标实际坐标信息包括目标实际方位Aj、目标实际俯仰Ej和目标实际距离Rj,目标在光电跟踪坐标系下的目标测量坐标信息包括目标测量方位Ai、目标测量俯仰Ei和目标测量距离Ri。
作为一种可参考的实施方式,本发明实施例的一种基于无人机和差分GPS的光电跟踪系统标校装置,可以采用如下方式实施:
部署点测量:
将差分GPS开机,待设备搜星完成正常工作后,在红外热像仪中心位置放置30s,测定得到部署点位置信息(即部署点坐标信息)。
标校点测量:
将差分GPS固定在旋翼无人机顶部,在不同方位、俯仰、距离上任意选择两个标校点,无人机起飞至其中一个标校点悬停30s,测定得到标校点真实值(即标校点实际坐标信息),与此同时,操作伺服控制组合使旋翼无人机保持在红外热像仪和可见光摄像机的图像中心位置,通过伺服转台读取该标校点当前的方位、俯仰信息,通过激光测距机获得目标和部署点之间距离信息,再以相同方式测量另一个标校点的方位、俯仰、距离信息。
光电跟踪坐标系计算:
通过部署点位置信息和两个标校点真实值计算出标校点在地理坐标系下相对于部署点的相对方位、相对俯仰、相对距离,结合光电跟踪坐标系下标校点方位、俯仰、距离的测量值(即标校点测量坐标信息),计算出地理坐标系相对于光电跟踪坐标系的方位角α、俯仰角β和横滚角γ,即坐标系O-X1Y1Z1沿OZ轴旋转α、沿OY轴旋转β、沿OX轴旋转γ可得到坐标系O-XYZ。
旋转矩阵计算:
三个方向的旋转矩阵可通过如下公式计算:
地理坐标系下目标方位、俯仰信息计算:
光电跟踪坐标系下目标位置为Pi,其在地理坐标系中的投影为Pj,则有:
[Pj]=PγPβPα[Pi]
通过光电跟踪系统测得的任意目标的位置信息为目标测量方位Ai、目标测量俯仰Ei和目标测量距离Ri,则目标在光电跟踪系统坐标系下的坐标信息为:Pi(RicosAicosEi,RicosAisinEi,RisinAi),已知Rj=Ri,经过旋转矩阵转换后则有:
由此可计算出目标在地理坐标系下目标实际方位Aj,目标实际俯仰Ej
Aj=arcsin[sinγcosAisin(Ei-α)-cosγsinβcosAicos(Ei-α)+cosβcosγsinAi]
实际标定过程中,计算出旋转矩阵后将Aj和Ej表达式中已知参数替换,只有Ai和Ei为变量,这样即可实现在软件中的实时标校过程。
本发明实施例的一种基于无人机和差分GPS的光电跟踪系统标校方法及装置。采用挂载高精度差分GPS的无人机在不同方位、俯仰和距离上静态测定多个标校点,获取标校点经度、维度和高度信息,同时光电跟踪系统将主传感器中心对准标校点,获取各标校点方位、俯仰和距离信息,任选两个标校点和设备部署点计算出当前光电跟踪系统姿态(方位角、俯仰角和横滚角),获取一次标校后,通过旋转矩阵补偿可获取目标实际方位、俯仰和距离信息,无须进行反复的基座调平、方位校北和标校验证工作。本发明实现了对光电跟踪系统的快速、高精度标校,解决以往光电跟踪系统标校过程中调平、校北过程繁琐和精度不高的问题。
最后应说明的是:以上实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。
Claims (10)
1.一种基于无人机和差分GPS的光电跟踪系统标校方法,其特征在于,包括:
步骤一,利用差分GPS采集光电跟踪系统在地理坐标系下的部署点坐标信息;
步骤二,将所述差分GPS挂载于旋翼无人机,利用所述旋翼无人机任意选择两个标校点,并利用所述差分GPS分别测定两个所述标校点在所述地理坐标系下的标校点实际坐标信息;
步骤三,通过所述光电跟踪系统分别测量两个所述标校点在光电跟踪坐标系下的标校点测量坐标信息;
步骤四,根据所述部署点坐标信息、两个所述标校点实际坐标信息和两个所述标校点测量坐标信息,计算出所述光电跟踪坐标系相对于所述地理坐标系的方位角、俯仰角和横滚角;
步骤五,基于所述方位角、所述俯仰角和所述横滚角,得到所述光电跟踪坐标系相对于所述地理坐标系的旋转矩阵;其中,所述旋转矩阵用于进行实时的标校补偿。
2.根据权利要求1所述的光电跟踪系统标校方法,其特征在于:
所述地理坐标系以地球正北方向为OX轴、以地球正东方向为OY轴、以垂直于地球表面向上为OZ轴;
所述光电跟踪坐标系以所述光电跟踪系统平面内伺服方位零位方向且垂直于俯仰零位平面为OX1轴、以所述光电跟踪系统平面内伺服俯仰零位方向且垂直于方位零位平面为OY1轴、以垂直于X1OY1平面向上为OZ1轴;
所述部署点坐标信息包括部署点在所述地理坐标系下的部署点经度、部署点纬度和部署点高度;所述标校点实际坐标信息包括所述标校点在所述地理坐标系下的实际方位、实际俯仰、实际距离;所述标校点测量坐标信息包括所述标校点在所述光电跟踪坐标系下的测量方位、测量俯仰和测量距离;
以及,步骤四包括:
根据所述部署点的部署点经度、部署点纬度、部署点高度和两个所述标校点的实际方位、实际俯仰、实际距离,计算出所述标校点在所述地理坐标系下相对于所述部署点的相对方位、相对俯仰和相对距离;
根据两个所述标校点相对于所述部署点的相对方位、相对俯仰和相对距离,以及两个所述标校点的测量方位、测量俯仰和测量距离,计算出所述光电跟踪坐标系相对于所述地理坐标系的方位角、俯仰角和横滚角。
4.根据权利要求1所述的光电跟踪系统标校方法,其特征在于:所述旋转矩阵用于将目标在所述光电跟踪坐标系下测得的目标测量坐标信息转换为在所述地理坐标系下的目标实际坐标信息。
6.根据权利要求1所述的光电跟踪系统标校方法,其特征在于:两个所述标校点位于,以所述光电跟踪系统为圆心、以所述旋翼无人机飞行限制距离为半径的范围内。
7.一种基于无人机和差分GPS的光电跟踪系统标校装置,其特征在于,包括光电跟踪系统、旋翼无人机和差分GPS;其中,所述光电跟踪系统包括红外热像仪、可见光摄像机、激光测距机、伺服转台、伺服控制组合、通信组合和后端显控设备;所述差分GPS为独立供电且离线存储定位数据;
所述差分GPS用于采集所述光电跟踪系统在地理坐标系下的部署点坐标信息、以及分别测定两个标校点在所述地理坐标系下的标校点实际坐标信息,并存储所述部署点坐标信息和所述标校点实际坐标信息;其中,所述地理坐标系以地球正北方向为OX轴、以地球正东方向为OY轴、以垂直于地球表面向上为OZ轴;所述部署点坐标信息包括部署点在所述地理坐标系下的部署点经度、部署点纬度和部署点高度;所述标校点实际坐标信息包括所述标校点在所述地理坐标系下的实际方位、实际俯仰、实际距离;
所述旋翼无人机用于挂载所述差分GPS、以及悬停在任意选择的两个所述标校点;
所述红外热像仪和所述可见光摄像机用于采集所述旋翼无人机的图像;所述伺服控制组合用于调整所述红外热像仪和所述可见光摄像机的角度,以将所述旋翼无人机保持在图像中心位置;
所述伺服转台用于读取目标或所述标校点的测量方位和测量俯仰;所述激光测距机用于获得所述目标与所述部署点之间的测量距离;其中,标校点测量坐标信息包括所述标校点在光电跟踪坐标系下的测量方位、测量俯仰和测量距离;所述光电跟踪坐标系以所述光电跟踪系统平面内伺服方位零位方向且垂直于俯仰零位平面为OX1轴、以所述光电跟踪系统平面内伺服俯仰零位方向且垂直于方位零位平面为OY1轴、以垂直于X1OY1平面向上为OZ1轴;
所述通信组合用于所述后端显控设备、所述红外热像仪、所述可见光摄像机、所述激光测距机、所述伺服转台、所述伺服控制组合之间的通信,以及传输图像、状态信息、控制指令和所述标校点测量坐标信息;
所述后端显控设备用于,对所述红外热像仪、所述可见光摄像机、所述激光测距机、所述伺服转台、所述伺服控制组合的控制;图像显示、状态显示和实时标校补偿;根据所述部署点坐标信息、两个所述标校点实际坐标信息和两个所述标校点测量坐标信息,计算出所述光电跟踪坐标系相对于所述地理坐标系的方位角、俯仰角和横滚角;以及,基于所述方位角、所述俯仰角和所述横滚角,得到所述光电跟踪坐标系相对于所述地理坐标系的旋转矩阵;其中,所述旋转矩阵用于进行实时的标校补偿。
8.根据权利要求7所述的光电跟踪系统标校装置,其特征在于:两个所述标校点位于,以光电跟踪系统为圆心、以旋翼无人机飞行限制距离为半径的半球范围内。
9.根据权利要求7所述的光电跟踪系统标校装置,其特征在于,所述后端显控设备进一步用于:
根据所述部署点的部署点经度、部署点纬度、部署点高度和两个所述标校点的实际方位、实际俯仰、实际距离,计算出所述标校点在所述地理坐标系下相对于所述部署点的相对方位、相对俯仰和相对距离;
根据两个所述标校点相对于所述部署点的相对方位、相对俯仰和相对距离,以及两个所述标校点的测量方位、测量俯仰和测量距离,计算出所述光电跟踪坐标系相对于所述地理坐标系的方位角、俯仰角和横滚角;
以及,采用如下公式计算所述旋转矩阵:
其中,α是所述方位角、β是所述俯仰角和γ是所述横滚角,Pα是OX1轴的旋转矩阵,Pβ是OY1轴的旋转矩阵,Pγ是OZ1轴的旋转矩阵。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111400335.9A CN114167900B (zh) | 2021-11-19 | 2021-11-19 | 一种基于无人机和差分gps的光电跟踪系统标校方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111400335.9A CN114167900B (zh) | 2021-11-19 | 2021-11-19 | 一种基于无人机和差分gps的光电跟踪系统标校方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114167900A true CN114167900A (zh) | 2022-03-11 |
CN114167900B CN114167900B (zh) | 2023-06-30 |
Family
ID=80480465
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111400335.9A Active CN114167900B (zh) | 2021-11-19 | 2021-11-19 | 一种基于无人机和差分gps的光电跟踪系统标校方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114167900B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114740511A (zh) * | 2022-06-13 | 2022-07-12 | 广州地铁设计研究院股份有限公司 | 基于测量机器人的无人机定位方法及无人机定位系统 |
CN115861860A (zh) * | 2023-02-24 | 2023-03-28 | 杭州靖安科技有限公司 | 一种无人机的目标跟踪定位方法和系统 |
Citations (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4954833A (en) * | 1989-07-05 | 1990-09-04 | The United States Of America As Represented By The Secretary Of The Navy | Method for determining astronomic azimuth |
CN101655361A (zh) * | 2009-08-31 | 2010-02-24 | 中国人民解放军国防科学技术大学 | 基于双相机的不稳定基准平台姿态测量方法 |
CN101839976A (zh) * | 2010-04-07 | 2010-09-22 | 中国人民解放军理工大学 | 利用北斗一号终端进行雷达系统误差估计的方法 |
CN104006787A (zh) * | 2014-05-01 | 2014-08-27 | 哈尔滨工业大学 | 空间飞行器姿态运动模拟平台高精度姿态确定方法 |
CN104422425A (zh) * | 2013-08-27 | 2015-03-18 | 北京航天计量测试技术研究所 | 一种不规则外形物体空间姿态动态测量方法 |
CN106030431A (zh) * | 2014-08-15 | 2016-10-12 | 深圳市大疆创新科技有限公司 | 传感器的自动标定系统及方法 |
CN107219520A (zh) * | 2017-05-31 | 2017-09-29 | 成都新越科技有限公司 | 一种反无人机分布式组网探测方法及其装置 |
CN107621647A (zh) * | 2017-09-25 | 2018-01-23 | 武汉霸云创新科技有限公司 | 一种克服导航卫星峡谷效应的定位系统及方法 |
GB201802445D0 (en) * | 2018-02-14 | 2018-03-28 | Openworks Eng Ltd | Calibration of object position-measuring apparatus |
CN108351649A (zh) * | 2015-09-15 | 2018-07-31 | 深圳市大疆创新科技有限公司 | 用于uav交互指令和控制的系统和方法 |
CN109116869A (zh) * | 2017-06-23 | 2019-01-01 | 北京臻迪科技股份有限公司 | 一种绕点飞行控制方法及装置 |
CN109212545A (zh) * | 2018-09-19 | 2019-01-15 | 长沙超创电子科技有限公司 | 基于主动视觉的多信源目标跟踪测量系统及跟踪方法 |
EP3506042A1 (en) * | 2017-12-27 | 2019-07-03 | Topcon Corporation | Three-dimensional information processing unit, apparatus having three-dimensional information processing unit, unmanned aerial vehicle, informing device, method and program for controlling mobile body using three-dimensional information processing unit |
CN110940354A (zh) * | 2019-12-02 | 2020-03-31 | 湖北航天技术研究院总体设计所 | 一种光电跟踪系统捷联惯导安装姿态的标定方法 |
CN112985398A (zh) * | 2019-12-16 | 2021-06-18 | 北京京邦达贸易有限公司 | 目标定位方法及系统 |
CN113091605A (zh) * | 2021-03-18 | 2021-07-09 | 中国电子科技集团公司第十一研究所 | 一种对光电系统的标定方法及计算机可读存储介质 |
CN113409400A (zh) * | 2021-06-17 | 2021-09-17 | 西安应用光学研究所 | 一种基于自动跟踪的机载光电系统目标地理定位方法 |
-
2021
- 2021-11-19 CN CN202111400335.9A patent/CN114167900B/zh active Active
Patent Citations (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4954833A (en) * | 1989-07-05 | 1990-09-04 | The United States Of America As Represented By The Secretary Of The Navy | Method for determining astronomic azimuth |
CN101655361A (zh) * | 2009-08-31 | 2010-02-24 | 中国人民解放军国防科学技术大学 | 基于双相机的不稳定基准平台姿态测量方法 |
CN101839976A (zh) * | 2010-04-07 | 2010-09-22 | 中国人民解放军理工大学 | 利用北斗一号终端进行雷达系统误差估计的方法 |
CN104422425A (zh) * | 2013-08-27 | 2015-03-18 | 北京航天计量测试技术研究所 | 一种不规则外形物体空间姿态动态测量方法 |
CN104006787A (zh) * | 2014-05-01 | 2014-08-27 | 哈尔滨工业大学 | 空间飞行器姿态运动模拟平台高精度姿态确定方法 |
CN106030431A (zh) * | 2014-08-15 | 2016-10-12 | 深圳市大疆创新科技有限公司 | 传感器的自动标定系统及方法 |
CN108351649A (zh) * | 2015-09-15 | 2018-07-31 | 深圳市大疆创新科技有限公司 | 用于uav交互指令和控制的系统和方法 |
CN107219520A (zh) * | 2017-05-31 | 2017-09-29 | 成都新越科技有限公司 | 一种反无人机分布式组网探测方法及其装置 |
CN109116869A (zh) * | 2017-06-23 | 2019-01-01 | 北京臻迪科技股份有限公司 | 一种绕点飞行控制方法及装置 |
CN107621647A (zh) * | 2017-09-25 | 2018-01-23 | 武汉霸云创新科技有限公司 | 一种克服导航卫星峡谷效应的定位系统及方法 |
EP3506042A1 (en) * | 2017-12-27 | 2019-07-03 | Topcon Corporation | Three-dimensional information processing unit, apparatus having three-dimensional information processing unit, unmanned aerial vehicle, informing device, method and program for controlling mobile body using three-dimensional information processing unit |
GB201802445D0 (en) * | 2018-02-14 | 2018-03-28 | Openworks Eng Ltd | Calibration of object position-measuring apparatus |
CN109212545A (zh) * | 2018-09-19 | 2019-01-15 | 长沙超创电子科技有限公司 | 基于主动视觉的多信源目标跟踪测量系统及跟踪方法 |
CN110940354A (zh) * | 2019-12-02 | 2020-03-31 | 湖北航天技术研究院总体设计所 | 一种光电跟踪系统捷联惯导安装姿态的标定方法 |
CN112985398A (zh) * | 2019-12-16 | 2021-06-18 | 北京京邦达贸易有限公司 | 目标定位方法及系统 |
CN113091605A (zh) * | 2021-03-18 | 2021-07-09 | 中国电子科技集团公司第十一研究所 | 一种对光电系统的标定方法及计算机可读存储介质 |
CN113409400A (zh) * | 2021-06-17 | 2021-09-17 | 西安应用光学研究所 | 一种基于自动跟踪的机载光电系统目标地理定位方法 |
Non-Patent Citations (1)
Title |
---|
宋亚等: "基于奇异值分解的光电跟踪系统标定方法", 《激光与红外》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114740511A (zh) * | 2022-06-13 | 2022-07-12 | 广州地铁设计研究院股份有限公司 | 基于测量机器人的无人机定位方法及无人机定位系统 |
CN115861860A (zh) * | 2023-02-24 | 2023-03-28 | 杭州靖安科技有限公司 | 一种无人机的目标跟踪定位方法和系统 |
Also Published As
Publication number | Publication date |
---|---|
CN114167900B (zh) | 2023-06-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110395390B (zh) | 一种多旋翼无人机免像控点三维建模与测图的装置及方法 | |
CN103837126B (zh) | 以天体位置作为标校基准的三维空间方向角测量装置及方法 | |
CN108318052A (zh) | 一种基于双轴连续旋转的混合式平台惯导系统标定方法 | |
CN114167900B (zh) | 一种基于无人机和差分gps的光电跟踪系统标校方法及装置 | |
CN110308746B (zh) | 一种适用于三轴转台式测控天线的星体标校方法 | |
US20180356223A1 (en) | Method for Checking and/or Calibrating a Horizontal Axis of a Rotating Laser | |
CN110503687B (zh) | 一种空中光电测量平台目标定位方法 | |
CN102538825B (zh) | 一种星敏感器探头组合体光轴指向标定方法 | |
CN109459059B (zh) | 一种星敏感器外场转换基准测定系统及方法 | |
CN106500731A (zh) | 一种基于恒星模拟系统的船载经纬仪的标校方法 | |
CN111811538B (zh) | 一种基于常见星体的光电经纬仪定向标校方法 | |
CN112197760A (zh) | 基于激光测距和自稳云台的无人机地形测绘装置及方法 | |
CN107860401A (zh) | 一种用于实时修正光电经纬仪指向值的测量装置及方法 | |
CN107589431B (zh) | 一种提高机载光电系统目标定位精度的校靶方法 | |
CN110296688A (zh) | 一种基于被动地理定位技术的侦测一体倾斜航测吊舱 | |
CN110285816A (zh) | 一种小卫星星上设备高精度姿态测量系统及方法 | |
CN113295049A (zh) | 一种运载火箭瞄准方法及装置 | |
CN114001756B (zh) | 一种小视场星敏感器外场地面寻星方法 | |
CN109470274B (zh) | 一种车载光电经纬仪载车平台变形测量系统及方法 | |
CN212206068U (zh) | 一种低空无人机摄影测量装置 | |
CN207423160U (zh) | 一种用于实时修正光电经纬仪指向值的测量装置 | |
CN207717986U (zh) | 一种基于双天线的倾斜测量装置 | |
CN111854800B (zh) | 陀螺寻北仪常数自标定及漂移量检测装置及其检测方法 | |
CN111897370B (zh) | 基于航姿仪的动态天线跟星参数校正方法 | |
CN111879298B (zh) | 一种用于月球无人值守望远镜的自动指星方法 |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |