CN107665183A - 一种异形装备车辆上两点位置换算方法 - Google Patents
一种异形装备车辆上两点位置换算方法 Download PDFInfo
- Publication number
- CN107665183A CN107665183A CN201710877948.9A CN201710877948A CN107665183A CN 107665183 A CN107665183 A CN 107665183A CN 201710877948 A CN201710877948 A CN 201710877948A CN 107665183 A CN107665183 A CN 107665183A
- Authority
- CN
- China
- Prior art keywords
- value
- measurement
- pitch
- distance
- angle
- 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
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/16—Matrix or vector computation, e.g. matrix-matrix or matrix-vector multiplication, matrix factorization
-
- 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
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F16/00—Information retrieval; Database structures therefor; File system structures therefor
- G06F16/20—Information retrieval; Database structures therefor; File system structures therefor of structured data, e.g. relational data
- G06F16/24—Querying
- G06F16/245—Query processing
- G06F16/2458—Special types of queries, e.g. statistical queries, fuzzy queries or distributed queries
- G06F16/2462—Approximate or statistical queries
Abstract
本发明公开一种异型装备车辆上两点位置换算方法,包括:S11:预先使用卫星定位天线测量卫星天线安装点和实际测量点的位置信息,计算所述两点之间的距离和俯仰角的测量值;S13:在异形装备车辆位置不变的情况下重复预定统计数量的测量,重复执行步骤S11;S15:采用汤姆松奇异值剔除法对该预定统计数量的测量值进行筛选,计算两点之间的距离统计值和俯仰角统计值;S17:外出任务时测量实际测量点的方位角实际测量值;S19:使用卫星定位天线测量卫星天线安装点的位置信息,利用所述两点之间的距离和俯仰角的统计值,以及所述方位角实际测量值计算实际测量点的位置信息。本发明使用的换算方法能够提高位置换算的精确度。
Description
技术领域
本发明涉及位置换算领域,更具体地,涉及一种异型装备车辆上两点位置换算方法。
背景技术
目前全球的武器系统都朝着高精尖的方向发展,各种装备车辆对定位精度要求越来越高,为满足需求,一般利用卫星定位设备进行高精度定位。但受装备车辆的形状、功能和卫星定位天线所需通视条件限制,往往卫星定位设备的定位天线无法安装于所需测量点上,只能安装于测量点附近的通视点上。如雷达车需要对雷达阵面中心进行定位,但雷达阵面中心都是精密电子元器件且本身不能遮挡,一般将卫星定位设备的定位天线安装于驾驶室上方,而雷达阵面到载车驾驶室上方有着复杂的结构传递关系(特别是转动活动的机构),使得位置换算十分困难,尤其是在异型(结构形状不规则)装备车辆的位置换算更为困难。一般情况下,直接将不经换算的定位结果装订给雷达阵面,或者每次定位后通过人工测量将位置点进行粗略换算。现有方法其存在以下缺点:
a)定位误差大:异型装备车辆上安装位置与实际所需位置本身就存在的很大的距离误差,少则几米,多则十几米;
b)人工测量操作复杂时间长:由于异型装备车辆本身结构不规则,而且一般车顶高度至少数米,人工测量难度大,安全性差,而且所需测量时间长;
c)推广应用性差:现在武器系统发展趋势均为精确打击,各装备车辆的精确定位也要求越来越高,至少需要分米级以上的定位精度,而现有方法的位置换算误差均在米级。
因此,针对现有位置换算方法存在的局限性,需要提供一种异型(结构形状不规则)装备车辆上两点位置换算方法。
发明内容
本发明的目的在于提供一种异型装备车辆上两点位置换算方法。该方法能够降低因现有定位方法、人工测量导致的测量误差,从而提高位置换算的精确度。
为达到上述目的,本发明采用下述技术方案:一种异型装备车辆上两点位置换算方法,包括步骤:
S11:预先使用卫星定位天线分别测量卫星天线安装点和实际测量点的位置信息,计算本次测量的所述两点之间的距离测量值和俯仰角测量值;
S13:在所述异形装备车辆位置不变的情况下重复预定统计数量的测量,重复执行步骤S11;
S15:采用汤姆松奇异值剔除方法对所述预定统计数量的测量值进行筛选,计算所述两点之间的距离统计值和俯仰角统计值;
S17:外出任务时测量实际测量点的方位角实际测量值;
S19:使用卫星定位天线测量卫星天线安装点的位置信息,利用所述两点之间的距离统计值和俯仰角统计值,以及所述方位角实际测量值计算实际测量点的位置信息。
更进一步地,所述步骤S11具体包括:
S111:使用两个卫星定位天线通过实时差分处理分别测量所述两个点的位置信息;
S113:将所述位置信息转换为北天东坐标系;
S115:使用北天东坐标系计算出本次测量的所述俯仰角测量值和距离测量值。
更进一步地,所述预定统计数量大于等于10。
更进一步地,所述步骤S15具体包括:
S151:使用所述预定统计数量的所述距离测量值和俯仰角测量值分别计算所述距离和俯仰角的平均值;
S153:使用所述预定统计数量的所述距离测量值和平均值,以及所述俯仰角测量值和平均值分别计算所述距离和俯仰角的方差;
S155:计算出所述距离统计值和俯仰角统计值。
更进一步地,外出任务时所述方位角实际测量值通过使用车载定向设备或车载寻北仪或卫星定向设备进行测量。
更进一步地,所述步骤S19具体包括:
S191:将所述卫星天线安装点的位置信息转换为北天东坐标系;
S193:根据所述距离统计值、所述俯仰角统计值和所述方位角实际测量值进行计算,并根据北天东坐标系计算出所述实际测量点的位置信息。
更进一步地,所述两点之间的距离统计值和俯仰角统计值每年重新标定一次,和或两点之间进行机械组装后重新标定一次。
本发明的有益效果如下:
本发明所述技术方案具有精确换算异型装备车辆上两点位置关系的能力,可以忽略异型车辆本身结构形状不规则的缺点,能够解决现有定位方法定位误差大、人工测量操作复杂时间长和推广应用性差的问题,能够有效规避所需测量的两个点之间机械结构的传递误差,可将误差控制到厘米级的范围内,使得整个精度链可以达到分米级。
附图说明
下面结合附图对本发明的具体实施方式作进一步详细的说明。
图1示出本发明所述异形装备车辆上两点位置换算方法的流程图;
图2示出本发明所述计算两点间距离和俯仰角的流程图;
图3示出本发明所述使用汤姆松奇异值剔除方法进行筛选的流程图;
图4示出本发明所述计算实际测量点的位置信息的流程图。
具体实施方式
为了更清楚地说明本发明,下面结合优选实施例和附图对本发明做进一步的说明。附图中相似的部件以相同的附图标记进行表示。本领域技术人员应当理解,下面所具体描述的内容是说明性的而非限制性的,不应以此限制本发明的保护范围。
在异型装备车上实现两点位置的精确换算,设置卫星天线安装点1(X1,Y1,Z1),实际所需测量点2(X2,Y2,Z2),两点间的相对位置关系方位角A、俯仰角E和距离D。图1示出本发明所述异形装备车辆上两点位置换算方法的流程图,一种异型装备车辆上两点位置换算方法,包括步骤:S11:预先使用卫星定位天线分别测量卫星天线安装点和实际测量点的位置信息,计算本次测量的所述两点之间的距离测量值和俯仰角测量值。
在一个具体的实施例中,图2示出本发明所述计算两点间距离和俯仰角的流程图,所述步骤S11具体包括:
S111:使用两个卫星定位天线通过实时差分处理分别测量所述两个点的位置信息。在异型装备车的驾驶室顶部加装有卫星定位天线,需要在实际测量点上临时加装一个卫星定位天线,可采用实时差分或者采集完数据后采用事后差分处理进行两个点的位置计算,要求差分定位精度达到厘米级。
S113:将所述位置信息转换为北天东坐标系。根据北天东坐标系与地心坐标系转换关系可得:
其中转换矩阵T可由安装点1(X1,Y1,Z1)转换为经纬高(lat,lon,h)得到:
t00=-sin(lat)×cos(lon);
t01=-sin(lat)×sin(lon);
t02=cos(lat);
t10=-sin(lon);
t11=cos(lon);
t12=0;
t20=cos(lat)×cos(lon);
t21=cos(lat)×sin(lon);
t22=sin(lat); (2)
则推导出:
S115:使用北天东坐标系计算出本次测量的所述俯仰角测量值和距离测量值。
由北天东坐标系可推算出俯仰角E和距离D:
S13:在所述异形装备车辆位置不变的情况下重复预定统计数量的测量,重复执行步骤S11;
为提高测量的精确度,保持异形装备车辆位置不变,重复进行测量。
在一个具体的实施例中,所述预定统计数量大于等于10。经过多次测量后分别得到多组测量数据,包括天线安装点的俯仰角E和距离D测量值和实际测量点的俯仰角E和距离D测量值。
S15:采用汤姆松奇异值剔除方法对所述预定统计数量的测量值进行筛选,计算所述两点之间的距离统计值和俯仰角统计值。为了检验系统测量数据中是否含有奇异值,本发明采用汤姆松(Thompson)奇异值剔除方法。
在一个具体的实施例中,图3示出本发明所述使用汤姆松奇异值剔除方法进行筛选的流程图,所述步骤S15具体包括:
S151:使用所述预定统计数量的所述距离测量值和俯仰角测量值分别计算所述距离和俯仰角的平均值;
根据测量得到的N个数据位X1、X2、X3、……、XN,在本发明中为预定统计数量的天线安装点的俯仰角E和距离D测量值。
为了检验是否含有奇异值,按照下列公式分别计算俯仰角E和距离D的平均值:
其中为子样平均值,N为统计数据的个数,本发明中为所述预定统计数量,k为数据的序号。
S153:使用所述预定统计数量的所述距离测量值和平均值,以及所述俯仰角测量值和平均值分别计算所述距离和俯仰角的方差。按照下列公式分别计算俯仰角E和距离D的方差:
其中为子样平均值,N为统计数据的个数,本发明中为所述预定统计数量,S2为子样方差,k为数据的序号。
S155:计算出所述距离统计值和俯仰角统计值。按照下列公式分别计算出对应的距离统计值和俯仰角统计值:
其中为子样平均值,N为统计数据的个数,本发明中为所述预定统计数量,S2为子样方差,k为数据的序号,其他为中间计算变量。
若|t′|>t(N-2,α),则xk被剔除,否则保留。这里,t(N-2,α)为学生氏t分布分位点,可根据自由度N-2和显著性水平α从学生氏t分布表查得。例如,N=10,α=0.05,可查得t(N-2,α)=2.306。根据上述计算得到所述两点之间的距离统计值和俯仰角统计值。
S17:外出任务时测量实际测量点的方位角实际测量值。由于方位角是根据车辆停放位置变化而变化的,因此在外出执行任务时需要对方位角进行实际测量。
在一个具体的实施例中,外出任务时所述方位角实际测量值通过使用车载定向设备或车载寻北仪或卫星定向设备进行测量。
S19:使用卫星定位天线测量卫星天线安装点的位置信息,利用所述两点之间的距离统计值和俯仰角统计值,以及所述方位角实际测量值计算实际测量点的位置信息。在外出任务时,根据卫星定位天线测量出的天线安装点的位置信息(X1,Y1,Z1),利用所述两点之间的俯仰角统计值E和距离统计值D,以及实际测量出的方位角测量值A进行位置换算,推算出实际测量点的位置信息(X2,Y2,Z2)。
在一个具体的实施例中,图4示出本发明所述计算实际测量点的位置信息的流程图,所述步骤S19具体包括:
S191:将所述卫星天线安装点的位置信息转换为北天东坐标系。根据北天东坐标系与地心坐标系转换关系可得:
按照前述方法计算出转换矩阵T。
S193:根据所述距离统计值、所述俯仰角统计值和所述方位角实际测量值进行计算,并根据北天东坐标系计算出所述实际测量点的位置信息。
将公式进行转换,计算转换矩阵中间值:
从而计算出转换矩阵中间值最后根据北天东坐标系计算出所述实际测量点的位置信息。
根据公式(13),计算出所述实际测量点的位置信息(X2,Y2,Z2)。
在一个具体的实施例中,所述两点之间的距离统计值和俯仰角统计值每年重新标定一次,和或两点之间进行机械组装后重新标定一次。为了保证两点之间的距离和俯仰角的精度,设置根据本发明所述方法每年重新标定一次两点之间的距离和俯仰角;当两点之间进行机械组装,为避免两点相对位置因机械组装发生变化,需要重新标定一次。
显然,本发明的上述实施例仅仅是为清楚地说明本发明所作的举例,而并非是对本发明的实施方式的限定,对于所属领域的普通技术人员来说,在上述说明的基础上还可以做出其它不同形式的变化或变动,这里无法对所有的实施方式予以穷举,凡是属于本发明的技术方案所引伸出的显而易见的变化或变动仍处于本发明的保护范围之列。
Claims (7)
1.一种异型装备车辆上两点位置换算方法,其特征在于,包括步骤:
S11:预先使用卫星定位天线分别测量卫星天线安装点和实际测量点的位置信息,计算本次测量的所述两点之间的距离测量值和俯仰角测量值;
S13:在所述异形装备车辆位置不变的情况下重复预定统计数量的测量,重复执行步骤S11;
S15:采用汤姆松奇异值剔除方法对所述预定统计数量的测量值进行筛选,计算所述两点之间的距离统计值和俯仰角统计值;
S17:外出任务时测量实际测量点的方位角实际测量值;
S19:使用卫星定位天线测量卫星天线安装点的位置信息,利用所述两点之间的距离统计值和俯仰角统计值,以及所述方位角实际测量值计算实际测量点的位置信息。
2.根据权利要求1所述的方法,其特征在于,所述步骤S11具体包括:
S111:使用两个卫星定位天线通过实时差分处理分别测量所述两个点的位置信息;
S113:将所述位置信息转换为北天东坐标系;
S115:使用北天东坐标系计算出本次测量的所述俯仰角测量值和距离测量值。
3.根据权利要求1所述的方法,其特征在于,所述预定统计数量大于等于10。
4.根据权利要求1所述的方法,其特征在于,所述步骤S15具体包括:
S151:使用所述预定统计数量的所述距离测量值和俯仰角测量值分别计算所述距离和俯仰角的平均值;
S153:使用所述预定统计数量的所述距离测量值和平均值,以及所述俯仰角测量值和平均值分别计算所述距离和俯仰角的方差;
S155:计算出所述距离统计值和俯仰角统计值。
5.根据权利要求1所述的方法,其特征在于,外出任务时所述方位角实际测量值通过使用车载定向设备或车载寻北仪或卫星定向设备进行测量。
6.根据权利要求1所述的方法,其特征在于,所述步骤S19具体包括:
S191:将所述卫星天线安装点的位置信息转换为北天东坐标系;
S193:根据所述距离统计值、所述俯仰角统计值和所述方位角实际测量值进行计算,并根据北天东坐标系计算出所述实际测量点的位置信息。
7.根据权利要求1所述的方法,其特征在于,所述两点之间的距离统计值和俯仰角统计值每年重新标定一次,和或两点之间进行机械组装后重新标定一次。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710877948.9A CN107665183B (zh) | 2017-09-26 | 2017-09-26 | 一种异形装备车辆上两点位置换算方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710877948.9A CN107665183B (zh) | 2017-09-26 | 2017-09-26 | 一种异形装备车辆上两点位置换算方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107665183A true CN107665183A (zh) | 2018-02-06 |
CN107665183B CN107665183B (zh) | 2021-02-12 |
Family
ID=61097756
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710877948.9A Active CN107665183B (zh) | 2017-09-26 | 2017-09-26 | 一种异形装备车辆上两点位置换算方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107665183B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108802701A (zh) * | 2018-06-22 | 2018-11-13 | 安徽尼古拉电子科技有限公司 | 一种基于北斗技术的车载雷达标定设备 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101907461A (zh) * | 2010-06-24 | 2010-12-08 | 西安电子科技大学 | 基于角度余切值的被动多传感器量测数据关联方法 |
CN104375135A (zh) * | 2014-11-05 | 2015-02-25 | 江苏舟航网络科技有限公司 | 射频定位方法、装置和系统 |
US20150116147A1 (en) * | 2013-10-31 | 2015-04-30 | Southwest Research Institute | Determination of Integrity of Incoming Signals of Satellite Navigation System |
CN103698744B (zh) * | 2014-01-02 | 2016-01-06 | 北京万集科技股份有限公司 | 一种基于角度测量的obu定位方法及系统 |
CN105242285A (zh) * | 2015-10-15 | 2016-01-13 | 北京航空航天大学 | 一种基于卫星通信的无人机导航数据被欺骗识别方法 |
-
2017
- 2017-09-26 CN CN201710877948.9A patent/CN107665183B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101907461A (zh) * | 2010-06-24 | 2010-12-08 | 西安电子科技大学 | 基于角度余切值的被动多传感器量测数据关联方法 |
US20150116147A1 (en) * | 2013-10-31 | 2015-04-30 | Southwest Research Institute | Determination of Integrity of Incoming Signals of Satellite Navigation System |
CN103698744B (zh) * | 2014-01-02 | 2016-01-06 | 北京万集科技股份有限公司 | 一种基于角度测量的obu定位方法及系统 |
CN104375135A (zh) * | 2014-11-05 | 2015-02-25 | 江苏舟航网络科技有限公司 | 射频定位方法、装置和系统 |
CN105242285A (zh) * | 2015-10-15 | 2016-01-13 | 北京航空航天大学 | 一种基于卫星通信的无人机导航数据被欺骗识别方法 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108802701A (zh) * | 2018-06-22 | 2018-11-13 | 安徽尼古拉电子科技有限公司 | 一种基于北斗技术的车载雷达标定设备 |
Also Published As
Publication number | Publication date |
---|---|
CN107665183B (zh) | 2021-02-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105910624B (zh) | 一种惯组光学瞄准棱镜安装误差的标定方法 | |
CN104359492B (zh) | 惯性导航和轮速计组成的航迹推算定位系统误差估算算法 | |
CN105203023B (zh) | 一种车载三维激光扫描系统安置参数的一站式标定方法 | |
CN104614750B (zh) | 车辆位置确定方法 | |
US8411285B2 (en) | Stationing an unleveled optical total station | |
CN109443349A (zh) | 一种姿态航向测量系统及其融合方法、存储介质 | |
CN105607650B (zh) | 一种指向性天线的角度标校装置及方法 | |
CN101413785B (zh) | 基于双旋转激光平面发射机网络的定位系统误差补偿方法 | |
CN111770436B (zh) | 一种基于CSI的室内Wi-Fi定位方法、装置及存储介质 | |
CN104457718B (zh) | Rsu安装参数标定方法 | |
CN105792349B (zh) | 信号强度分布建立方法及无线定位系统 | |
CN112833917B (zh) | 基于磁航向角和最小二乘法的三轴磁传感器标定方法 | |
CN109959898B (zh) | 一种座底式水声被动定位基阵自校准方法 | |
CN113341384A (zh) | 雷达校准 | |
CN102108856B (zh) | 小角度井斜姿态测量方法及装置 | |
CN103630107A (zh) | 一种基站天线倾角测量方法及数据处理方法 | |
CN107665183A (zh) | 一种异形装备车辆上两点位置换算方法 | |
CN115096303A (zh) | 一种gnss多天线与ins紧组合定位定姿方法和设备 | |
CN107576975B (zh) | 应用于卫星导航系统的误差评估的模型的处理方法和装置 | |
CN110275139B (zh) | 一种基于旋转式基元复用的超短基线定位系统及方法 | |
CN107505638B (zh) | 一种基于高精度定向技术的车辆上两点位置换算方法 | |
CN112954585B (zh) | 一种基于uwb的农业机械田间定位系统及方法 | |
CN110146052A (zh) | 一种基于全站仪的平面法线天文定向测量方法及系统 | |
CN108693518B (zh) | 一种室内定位方法 | |
CN110196444A (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 |