CN105911576B - 确定分布式协同***中副分***的位置信息的方法及装置 - Google Patents
确定分布式协同***中副分***的位置信息的方法及装置 Download PDFInfo
- Publication number
- CN105911576B CN105911576B CN201610217778.7A CN201610217778A CN105911576B CN 105911576 B CN105911576 B CN 105911576B CN 201610217778 A CN201610217778 A CN 201610217778A CN 105911576 B CN105911576 B CN 105911576B
- Authority
- CN
- China
- Prior art keywords
- subsystem
- position information
- equipment
- coordinate system
- calibration system
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 42
- 238000010586 diagram Methods 0.000 description 5
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000004075 alteration Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
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
- 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
- G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
- G01S19/47—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
-
- 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/40—Correcting position, velocity or attitude
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Automation & Control Theory (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明公开了一种确定分布式协同***中副分***的位置信息的方法及装置。该方法包括:固定分***、校准设备的位置;获取主校准、副校准***设备的第一位置和第二位置信息,并确定副校准***设备在主校准***设备对应坐标系下的第三位置信息;确定副分***设备在副校准***设备对应坐标系下的第四位置信息,并确定副分***设备在主校准***设备对应坐标系下的第五位置信息;确定主分***设备在主校准***设备对应坐标系下的第六位置信息,并确定副分***在主分***对应坐标系下的位置信息。本发明可以解决现有技术将分***的位置中心与校准设备对应的位置中心默认重合而导致获取的副分***相对于主分***的位置信息误差相对较大的问题。
Description
技术领域
本发明涉及电子技术领域,尤其涉及确定分布式协同***中副分***的位置信息的方法及装置。
背景技术
目前,在许多应用场景中,例如,交通工具的导航、大气物理的观测、天体的运动等分布式协同***,均需要对该***中的各分***进行定位处理,具体地,通常根据一个分***(主分***)的位置信息确定另一个分***(副分***)相对于该主分***的位置信息。
现有技术在获取副分***相对于主分***的位置信息时,会在主分***和副分***上分别设置有主分***设备和副分***设备,该主分***设备和副分***设备具体用于测取该副分***相对于该主分***的位置信息;而且,通常为了对分***设备测取的副分***相对于主分***的位置信息的准确性进行判断和修正,会在该主分***和副分***的附近分别设有主校准***设备和副校准***设备,该校准设备同样用于测取该副分***相对于该主分***的位置信息;最后,根据校准设备测取的位置信息和分***设备测取的位置信息,确定该副分***相对于主分***的位置信息的误差范围,并根据该误差范围对分***设备测得的位置信息进行修正,从而得到较为精确的该副分***相对于主分***的位置信息。
具体地,现有技术利用校准设备获取副分***相对于主分***的位置信息的具体步骤是:首先,确定主分***的位置信息,然后,根据主分***的位置信息建立坐标系(主分***对应的坐标系),通常将主分***的位置中心作为原点建立坐标系,最后,利用校准设备获取副分***在主分***对应坐标系中的位置信息。
上述现有技术在利用校准设备获取副分***相对于主分***的位置信息的过程中,通常会默认主校准***设备的位置中心与主分***的位置中心重合,以及默认副校准***设备的位置中心与副分***的位置中心重合,因此在根据主分***的位置信息建立坐标系时,通常会将主校准***设备的位置中心作为坐标原点建立坐标系,从而利用主校准***设备测取该副校准***的位置中心在该坐标系的位置信息,则该位置信息作为最终测取的副分***相对于主分***的位置信息。但在实际情况中,主分***的位置中心与主校准***设备的位置中心并不重合,且副分***的位置中心与副校准***设备的位置中心也不重合,如图1所示,以主校准***设备的位置中心O为坐标原点建立坐标系,但主分***的位置中心C与主校准***设备的位置中心O并不重合,因此,现有技术使用校准设备获取的副分***相对于主分***的位置信息的误差相对较大。
发明内容
鉴于上述问题,本发明实施例提供了一种确定分布式协同***中副分***的位置信息的方法,用于解决现有技术中在利用副校准***设备获取副分***设备的位置信息时,由于默认该校准设备与该分***对应的位置中心重合而导致获得的副分***相对于主分***的位置信息误差相对较大的问题。
一种确定分布式协同***中副分***的位置信息的方法,该方法包括:固定分***设备和校准设备的位置,其中,所述分***设备包括主分***设备和副分***设备,所述校准设备包括主校准***设备和副校准***设备;获取所述主校准***设备的第一位置信息,以及获取所述副校准***设备的第二位置信息,并根据所述第一位置信息和第二位置信息确定所述副校准***设备在所述主校准***设备对应坐标系下的第三位置信息;确定所述副分***设备在所述副校准***设备对应坐标系下的第四位置信息,并根据所述第三位置信息和第四位置信息确定所述副分***设备在所述主校准***设备对应坐标系下的第五位置信息;确定所述主分***设备在所述主校准***设备对应坐标系下的第六位置信息,并根据所述第五位置信息和第六位置信息确定所述副分***在所述主分***对应坐标系下的位置信息。
优选地,所述确定所述副分***设备在所述副校准***设备对应坐标系下的第四位置信息包括:
确定所述副分***设备的位置中心的投影与所述副校准***设备的第一设备的位置中心之间的第一距离,以及确定所述投影与所述副分***设备的位置中心之间的第二距离,其中,所述投影为所述副分***设备的位置中心在所述副校准***设备的第一设备的位置中心与所述副校准***设备的第二设备的位置中心之间连线上的投影;
根据所述第一距离和第二距离确定所述副分***设备在所述副校准***设备对应坐标系下的第四位置信息。
优选地,所述确定所述主分***设备在所述主校准***设备对应坐标系下的第六位置信息包括:
确定所述主分***设备的位置中心的投影与所述主校准***设备的第一设备的位置中心之间的第三距离,以及确定所述投影与所述主分***设备的位置中心之间的第四距离,其中,所述投影为所述主分***设备的位置中心在所述主校准***设备的第一设备的位置中心与所述主校准***设备的第二设备的位置中心之间连线上的投影;
根据所述第三距离和第四距离确定所述主分***设备在所述主校准***设备对应坐标系下的第六位置信息。
优选地,所述获取所述主校准***设备的第一位置信息,以及获取所述副校准***设备的第二位置信息,具体包括:
采用差分GNSS获取所述主校准***设备在经纬高坐标系下的第一位置信息,以及获取所述副校准***设备在经纬高坐标系下的第二位置信息。
优选地,所述根据所述第一位置信息和第二位置信息确定所述副校准***设备在所述主校准***设备对应坐标系下的第三位置信息,具体包括:
根据所述主校准***设备在经纬高坐标系下的第一位置信息,以及所述副校准***设备在经纬高坐标系下的第二位置信息,确定所述副校准***设备在所述主校准***设备对应的东北天坐标系下的第三位置信息。
优选地,在获取所述主校准***设备在经纬高坐标系下的第一位置信息以及获取所述副校准***设备在经纬高坐标系下的第二位置信息之后,所述方法还包括:
将所述第一位置信息和第二位置信息分别转换成在大地空间直角坐标系下的位置信息;
根据所述第一位置信息和第二位置信息在大地空间直角坐标系下的位置信息,确定所述副分***设备在所述主分***设备对应的东北天坐标系下的第三位置信息。
优选地,在确定所述副校准***设备在所述主校准***设备对应的东北天坐标系下的位置信息之后,所述方法还包括:
将所述副分***设备在所述主分***设备对应的东北天坐标系下的位置信息转换成在所述主分***设备对应的惯导坐标系下的位置信息。
优选地,在根据所述第五位置信息和第六位置信息确定所述副分***在所述主分***对应坐标系下的位置信息后,所述方法还包括:
根据所述副分***在所述主分***对应坐标系下的位置信息,对所述分***设备测得的所述副分***在所述主分***对应坐标系下的位置信息进行校准,得到所述副分***在所述主分***对应坐标系下的位置信息的误差范围。
优选地,所述根据所述副分***在所述主分***对应坐标系下的位置信息,对所述分***设备测得的所述副分***在所述主分***对应坐标系下的位置信息进行校准,具体包括:
通过所述分***设备的秒脉冲数据与所述校准设备经过GNSS差分同步后的秒脉冲数据进行对比,对所述分***设备中的秒脉冲数据进行校准,并根据所述校准后的脉冲数据和所述副分***在所述主分***对应坐标系下的位置信息,对所述分***设备测得的所述副分***在所述主分***对应坐标系下的位置信息进行校准。
一种确定分布式协同***中副分***的位置信息的装置,该装置包括:
固定单元、获取单元、第一确定单元和第二确定单元,其中:
所述固定单元,用于固定分***设备和校准设备的位置,其中,所述分***设备包括主分***设备和副分***设备,所述校准设备包括主校准***设备和副校准***设备;
所述获取单元,用于获取所述主校准***设备的第一位置信息,以及获取所述副校准***设备的第二位置信息,并根据所述第一位置信息和第二位置信息确定所述副校准***设备在所述主校准***设备对应坐标系下的第三位置信息;
所述第一确定单元,用于确定所述副分***设备在所述副校准***设备对应坐标系下的第四位置信息,并根据所述第三位置信息和第四位置信息确定所述副分***设备在所述主校准***设备对应坐标系下的第五位置信息;
所述第二确定单元,用于确定所述主分***设备在所述主校准***设备对应坐标系下的第六位置信息,并根据所述第五位置信息和第六位置信息确定所述副分***在所述主分***对应坐标系下的位置信息。
本发明提供了一种确定分布式协同***中副分***的位置信息的方法,该方法具体包括:第一步:固定分***设备和校准设备的位置,其中,该分***设备包括主分***设备和副分***设备,该校准设备包括主校准***设备和副校准***设备,第二步:获取该主校准***设备的第一位置信息,以及获取该副校准***设备的第二位置信息,并根据该第一位置信息和第二位置信息确定该副校准***设备在该主校准***设备对应坐标系下的第三位置信息,第三步:确定该副分***设备在该副校准***设备对应坐标系下的第四位置信息,并根据该第三位置信息和第四位置信息确定该副分***设备在该主校准***设备对应坐标系下的第五位置信息,第四步:确定该主分***设备在该主校准***设备对应坐标系下的第六位置信息,并根据该第五位置信息和第六位置信息确定该副分***在该主分***对应坐标系下的位置信息。相比于现有技术,本发明考虑到校准设备与相应的分***之间的位置中心并不重合的问题,在利用校准设备获取副分***相对于主分***的位置信息时,计算该副分***在该副校准***设备对应坐标系下的坐标,以及计算该主分***在该主校准***设备对应坐标下的坐标,从而确定该副分***在该主分***对应坐标系下的位置信息,解决了现有技术中将分***的位置中心与校准设备对应的位置中心默认重合而导致获取的副分***相对于主分***的位置信息的误差相对较大的问题。
附图说明
此处所说明的附图用来提供对本发明的进一步理解,构成本发明的一部分,本发明的示意性实施例及其说明用于解释本发明,并不构成对本发明的不当限定。在附图中:
图1为本发明提供的一种现有技术确定分布式协同***中副分***的位置信息的方法的示意图;
图2为本发明提供的一种现有技术确定分布式协同***中副分***的位置信息的方法的示意图;
图3为本发明实施例1提供的一种确定分布式协同***中副分***的位置信息的方法的流程示意图;
图4为本发明实施例1提供的一种确定分布式协同***中副分***的位置信息的方法的示意图;
图5为本发明实施例2提供的一种确定分布式协同***中副分***的位置信息的装置的结构示意图。
具体实施方式
在前述背景技术中已经记载,现有技术在获取副分***相对于主分***的位置信息时,首先,确定主分***的位置信息,然后,通过校准设备测取副分***在该主分***对应坐标系下的位置信息(即该副分***相对于该主分***的位置信息)。如图2所示,将主校准***设备对应的位置中心O作为坐标原点建立坐标系,副校准***设备的位置中心B在该坐标系的位置信息为最终确定的副分***相对于主分***的位置信息。
但是现有技术中校准设备在测取副分***相对于主分***的位置信息时,通常默认主校准***设备的位置中心与主分***的位置中心重合,以及默认副校准***设备的位置中心与副分***的位置中心重合。如图2所示,主分***的位置中心为C,对应的主校准***设备的位置中心为O,副分***的位置中心为A,对应的副校准***设备的位置中心为B,现有技术中会默认C与O重合,以及默认B与A重合,而实际情况,C与O并不重合,B与A也不重合。因此,现有技术在获取副分***的位置信息时,没有考虑分***的位置中心与对应的校准设备的位置中心不重合的问题,导致获得的副分***相对于主分***的位置信息误差相对较大。
鉴于上述问题,本发明实施例提供了一种确定分布式协同***中副分***的位置信息的方法。为使本发明的目的、技术方案和优点更加清楚,下面将结合本发明具体实施例及相应的附图对本发明技术方案进行清楚、完整地描述。显然,所描述的实施例仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
在说明本发明实施例之前,需要说明的是:
1、本发明中的分***位置信息与对应分***设备的位置信息一致,具体地,主分***的位置信息与该主分***设备的位置信息一致,同理,副分***的位置信息与该副分***设备的位置信息一致。
2、本发明中的“主分***”和“副分***”中的“主”和“副”是为了清楚的说明本发明,用于区分两个不同分***,这里也可以将“主分***”称为“第一***”,且将“副分***”称为“第二***”等等,这里对这两分***的名称不作具体限定。
以下结合附图,详细说明本发明各实施例提供的技术方案。
实施例1
实施例1提供了一种确定分布式协同***中副分***的位置信息的方法,用于解决现有技术中由于分***与校准设备的位置中心不重合而导致获得的副分***相对于主分***的位置信息误差相对较大的问题。该方法的具体流程示意图如图3所示,包括下述步骤:
步骤31:固定分***设备和校准设备的位置,其中,所述分***设备包括主分***设备和副分***设备,所述校准设备包括主校准***设备和副校准***设备。
在前述内容已经提到,根据主分***的位置信息确定副分***相对于主分***的位置信息时,在主分***和副分***上分别安装主分***设备和副分***设备,且在主分***和副分***上还分别安装主校准***设备和副校准***设备。本步骤中,需要固定分***设备和校准设备的位置,具体地,固定主分***设备和主校准***设备的位置,以及固定副分***和副校准***设备的位置。
步骤32:获取所述主校准***设备的第一位置信息,以及获取所述副校准***设备的第二位置信息,并根据所述第一位置信息和第二位置信息确定所述副校准***设备在所述主校准***设备对应坐标系下的第三位置信息。
在本步骤中,首先,获取主校准***设备的第一位置信息,以及获取副校准***设备的第二位置信息。这里的获取的第一位置信息和第二位置信息可以是通过GNSS(全球卫星导航***)定位的方式获取主校准***设备和副校准***设备在经纬高坐标系下的位置信息。
然后,根据该主校准***设备在经纬高坐标系下的位置信息(第一位置信息),获取该主校准***设备在大地空间直角坐标系下的位置信息,以及根据该副校准***设备在经纬高坐标系下的位置信息(第二位置信息),获取该副校准***设备在大地空间直角坐标下的位置信息。
具体地,可以根据下述公式对分***在经纬高坐标系下的位置信息进行转换,得到该分***在大地空间直角坐标系下的位置信息,该转换公式为:
其中,(B,L,H)为分***在经纬高坐标系下的位置信息,N为椭球卯酉圈曲率半径,a为椭球的长半径,b为椭球的短半径,e为椭球的第一偏心率,f为椭球扁律。
在利用公式1-1获得主校准***设备和副校准***设备在大地空间直角坐标系下的位置信息之后,根据获得的该大地空间直角坐标系下的位置信息,确定该副校准***设备在该主校准***设备对应的东北天坐标系下的位置信息(第三位置信息)。
具体地,可以根据下述公式确定该副校准***设备在该主校准***设备对应的东北天坐标系下的位置信息,该确定公式为:
其中,(Bo,Lo,Ho)为主分***在经纬高坐标系下的位置信息,(Xo,Yo,Zo)为主分***在大地空间直角坐标系下的位置信息,(X1,Y1,Z1)为副分***在大地空间直角坐标系下的位置信息,(xo,yo,zo)为该副校准***设备在该主校准***设备对应的东北天坐标系下的位置信息。
步骤33:确定所述副分***设备在所述副校准***设备对应坐标系下的第四位置信息,并根据所述第三位置信息和第四位置信息确定所述副分***设备在所述主校准***设备对应坐标系下的第五位置信息。
在本步骤中,需要确定该副分***设备在与该副分***设备对应的副校准***设备对应坐标系下的第四位置信息,这里第四信息可以是该副分***设备在该副校准***设备对应的东北天坐标系下的位置信息,具体地,确定该第四信息的方法可以是:
第一步:确定该副分***设备的位置中心的投影与该副校准***设备的第一设备的位置中心之间的第一距离,以及确定该投影与该副分***设备的位置中心之间的第二距离,其中,该投影为该副分***设备的位置中心在该副校准***设备的第一设备的位置中心与该副校准***设备的第二设备的位置中心之间连线上的投影。
这里副校准***设备的第一设备可以是指GNSS设备,副校准***设备的第二设备可以是指惯导设备等,这里不作具体限定。具体如图4所示,C为副分***设备的位置中心,C′为该副分***设备的位置中心在副校准***设备的第一设备(GNSS设备)的位置中心和副校准***设备的第二设备(惯导设备)的位置中心连线上的投影,且惯导设备天线A与惯导设备天线B共同构成了惯导设备。则该投影C′与该副校准***设备的第一设备的位置中心的第一距离为L,该投影与该副分***设备的位置中心的第二距离为h。
第二步:根据惯导信息(β1,ε1,ω1),确定该投影的位置信息,具体地,确定该投影的位置信息的公式可以是:
上述惯导信息(β1,ε1,ω1)表示建立的惯导坐标系在以副校准***设备的位置中心为原点建立的东北天坐标系中的位置信息。
第三步:确定副分***设备的位置中心在副校准***设备对应的东北天坐标系下的第四位置信息,具体地,根据上述投影位置关系,确定该第四位置信息的关系式可以是:
其中,(xC1,yC1,zC1)为第四位置信息,则通过解方程可得该第四位置信息为:
当ω1<0时,则
当ω1≥0时,则
其中:P=2sinβ1(h1tanε1cosω1-l1cosε1)
Q=l1 2cos2ε1sin2β1-h1 2(sin2ε1cos2β1-tan2ε1cos2ω1)-2l1h1sinε1cosω1sin2β1
在获得副分***设备在副校准***设备对应的东北天坐标系下的第四位置信息后,根据步骤32获得该副校准***设备在主校准***设备对应的东北天坐标系下的第三位置信息,以及本步骤获得的第四位置信息,确定该副分***设备在该主校准***设备对应的东北天坐标系下的第五位置信息,可以采用下述公式进行确定:
其中,(xG1,yG1,zG1)为该副分***设备在副校准***设备对应的东北天坐标系下的第五位置信息。
步骤34:确定所述主分***设备在所述主校准***设备对应坐标系下的第六位置信息,并根据所述第五位置信息和第六位置信息确定所述副分***在所述主分***对应坐标系下的位置信息。
在步骤中,首先需要确定主分***设备在主校准***设备对应坐标系下的第六位置信息,这里的第六位置信息同样也可以是该主分***设备在该主校准***设备对应的东北天坐标系下的第六信息。
获取该第六位置信息的方式可以采用步骤33获取副分***设备在副校准***设备对应的东北天坐标系下的位置信息的方式,则获取该第六位置信息的具体方法是:
第一步:确定该主分***设备的位置中心的投影与该主校准***设备的第一设备的位置中心之间的第一距离,以及确定该投影与该主分***设备的位置中心之间的第二距离,其中,该投影为该主分***设备的位置中心在该主校准***设备的第一设备的位置中心与该主校准***设备的第二设备的位置中心之间连线上的投影;同理,这里的主校准***设备的第一设备也可以是GNSS设备,主校准***设备的第二设备也可以是惯导设备。
第二步:根据惯导设备信息并采用公式1-3,确定该投影的位置信息。
第三步:根据该投影位置关系并采用公式1-4,确定主分***设备在主校准***设备对应的东北天坐标系下的第六位置信息。
在获取该主分设备在该主校准***设备对应的东北天坐标系下的第六位置信息后,根据步骤33获得的副分***设备在主校准***设备对应的东北天坐标系下的第五位置信息,以及本步骤获得的第六位置信息,确定该副分***设备在该主分***设备对应坐标系下的位置信息。
上述确定该副分***设备在该主分***设备对应坐标系下的位置信息,可以是该副分***设备在该主分***设备对应的东北天坐标系下的位置信息,具体可以采用下述公式:
其中,(xT1,yT1,zT1)为该副分***设备在该主分***设备对应的东北天坐标系下的位置信息。
在采用公式1-8中获取的副分***设备在主分***设备对应的东北天坐标系下的位置信息后,可以将该坐标信息准换成在惯导坐标系下的位置信息,具体可以采用下述公式:
其中,(βZ,εZ,ωZ)为该主分***设备的位置中心在惯导坐标系下的位置信息,(xG,yG,zG)为该副分***设备在该主分***设备对应的惯导坐标系下的位置信息。
在获得该副分***设备在主分***设备对应的惯导坐标系下的位置信息后,在将该位置信息转化成在该主分***设备对应坐标系下的位置信息,这时获得的位置信息为最终用户需要获得的该副分***相对于主分***的位置信息。具体采用下述公式:
其中,(α,θ,γ)为主分***设备对应的惯导坐标系与该主分***设备对应坐标系之间的旋转角度坐标信息,(x,y,z)为该副分***相对于该主分***的位置信息。
在利用校准设备获得副分***在主分***对应坐标系下的位置信息后,需要对该分***设备测得的该副分***在该主分***对应坐标系下的位置信息进行校准,从而得到该副分***在该主分***对应坐标系下的位置信息的误差范围。例如,分***设备测得副分***相对于主分***的位置信息为A,对应的校准设备获得的该副分***相对于该主分***的位置信息为B,则可以将|B-A|作为该副分***相对于该主分***的位置信息的误差范围,这里的误差范围|B-A|只是示例性的说明,在实际应用中,还会有更加复杂的、更加精确的获取误差范围的方法,这里不作具体限定。
另外,在根据校准设备测取的副分***在主分***对应坐标系下的位置信息,对该分***设备测得的该副分***在该主分***对应坐标系下的位置信息进行校准时,为了更加精确地进行校准工作,可以对该分***的秒脉冲数据与校准设备经过GNSS差分同步后的秒冲数据进行对比,从而对该分***设备中的秒脉冲数据进行校准,使得分***设备中的时间信息与校准设备中的时间信息一致,即使得校准设备与分***设备达到同步校准数据的效果。
综上所述,本发明在获取副分***在主分***对应坐标系下的位置信息时,通过分***设备和校准设备(例如GNSS设备和惯导设备)之间的协同工作,最终获取副分***在主分***对应坐标系下的位置信息,另外,利用GNSS的时间同步功能,对分***和校准设备中的时间信息进行校准,使得最终获得的副分***相对于主分***的位置信息更加的精确。
本发明实施例提供了一种确定分布式协同***中副分***的位置信息的方法,该方法具体包括:第一步:固定分***设备和校准设备的位置,其中,该分***设备包括主分***设备和副分***设备,该校准设备包括主校准***设备和副校准***设备,第二步:获取该主校准***设备的第一位置信息,以及获取该副校准***设备的第二位置信息,并根据该第一位置信息和第二位置信息确定该副校准***设备在该主校准***设备对应坐标系下的第三位置信息,第三步:确定该副分***设备在该副校准***设备对应坐标系下的第四位置信息,并根据该第三位置信息和第四位置信息确定该副分***设备在该主校准***设备对应坐标系下的第五位置信息,第四步:确定该主分***设备在该主校准***设备对应坐标系下的第六位置信息,并根据该第五位置信息和第六位置信息确定该副分***在该主分***对应坐标系下的位置信息。相比于现有技术,本发明实施例考虑到校准设备与相应的分***之间的位置中心并不重合的问题,在获取副分***相对于主分***的位置信息时,计算该副分***在该副校准***设备对应坐标系下的坐标,以及计算该主分***在该主校准***设备对应坐标下的坐标,从而确定该副分***在该主分***对应坐标系下的位置信息,解决了现有技术中将分***设备对应的位置中心与校准设备对应的位置中心默认重合而导致获取的副分***相对于主分***的位置信息误差相对较大的问题。
需要说明的是,实施例1所提供方法的各步骤的执行主体均可以是同一设备,或者,该方法的各步骤也可以由不同设备作为执行主体。比如,步骤31和步骤32的执行主体可以为设备1;又比如,步骤31的执行主体可以为设备1,步骤32和的执行主体可以为设备2;等等。
实施例2
实施例1提供了一种确定分布式协同***中副分***的位置信息的方法,相应地,本发明实施例提供了一种确定分布式协同***中副分***的位置信息的装置,用于解决现有技术中由于分***设备与校准设备的位置中心不重合而导致获得的副分***相对于主分***的位置信息误差较大的问题。该装置的具体结构如图5所示,该装置包括:
固定单元51、获取单元52、第一确定单元53和第二确定单元54,其中:
所述固定单元51,可以用于固定分***设备和校准设备的位置,其中,所述分***设备包括主分***设备和副分***设备,所述校准设备包括主校准***设备和副校准***设备;
所述获取单元52,可以用于获取所述主校准***设备的第一位置信息,以及获取所述副校准***设备的第二位置信息,并根据所述第一位置信息和第二位置信息确定所述副校准***设备在所述主校准***设备对应坐标系下的第三位置信息;
所述第一确定单元53,可以用于确定所述副分***设备在所述副校准***设备对应坐标系下的第四位置信息,并根据所述第三位置信息和第四位置信息确定所述副分***设备在所述主校准***设备对应坐标系下的第五位置信息;
所述第二确定单元54,可以用于确定所述主分***设备在所述主校准***设备对应坐标系下的第六位置信息,并根据所述第五位置信息和第六位置信息确定所述副分***在所述主分***对应坐标系下的位置信息。
本发明装置实施例的具体工作流程是:第一步:固定单元51固定分***设备和校准设备的位置,其中,该分***设备包括主分***设备和副分***设备,该校准设备包括主校准***设备和副校准***设备,第二步:获取单元52获取该主校准***设备的第一位置信息,以及获取该副校准***设备的第二位置信息,并根据该第一位置信息和第二位置信息确定该副校准***设备在该主校准***设备对应坐标系下的第三位置信息,第三步:第一确定单元53确定该副分***设备在该副校准***设备对应坐标系下的第四位置信息,并根据该第三位置信息和第四位置信息确定该副分***设备在该主校准***设备对应坐标系下的第五位置信息,第四步:第二确定单元54确定该主分***设备在该主校准***设备对应坐标系下的第六位置信息,并根据该第五位置信息和第六位置信息确定该副分***在该主分***对应坐标系下的位置信息。
上述装置实施例实现确定副分***的位置信息的方式有很多种,例如,在一种实施方式中,所述装置还包括校准单元55,所述校准单元55可以用于:
在根据所述第五位置信息和第六位置信息确定所述副分***设备在所述主分***设备对应坐标系下的位置信息后,根据所述副分***在所述主分***对应坐标系下的位置信息,对所述分***设备测得的所述副分***在所述主分***对应坐标系下的位置信息进行校准,得到所述副分***在所述主分***对应坐标系下的位置信息的误差范围。
该实施方式获得的有益效果是:通过校准***设备获得的副分***相对于主分***的位置信息,对该分***设备测取的该副分***相对于主分***的位置信息进行校准,得到该位置信息的误差范围,使获得的该副分***相对于该主分***的位置信息更加精确。
在另一种实施方式中,所述校准单元55根据所述副分***在所述主分***对应坐标系下的位置信息,对所述分***设备测得的所述副分***在所述主分***对应坐标系下的位置信息进行校准,具体包括:
通过所述分***设备的秒脉冲数据与所述校准设备经过GNSS差分同步后的秒脉冲数据进行对比,对所述分***设备中的秒脉冲数据进行校准,并根据所述校准后的脉冲数据和所述副分***在所述主分***对应坐标系下的位置信息,对所述分***设备测得的所述副分***在所述主分***对应坐标系下的位置信息进行校准。
该实施方式获得有益效果是:通过分***设备的秒脉冲数据与校准设备经过GNSS差分同步后的秒脉冲数据进行对比,对该分***设备中的秒脉冲数据进行校准,使得该校准设备可以同步对相应的分***设备测得的位置信息进行校准,使获得的副分***相对于主分***的位置信息更加精确。
以上仅为本发明的实施例而已,并不用于限制本发明。对于本领域技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原理之内所作的任何修改、等同替换、改进等,均应包含在本发明的权利要求范围之内。
Claims (10)
1.一种确定分布式协同***中副分***的位置信息的方法,其特征在于,该方法包括:
固定分***设备和校准设备的位置,其中,所述分***设备包括主分***设备和副分***设备,所述校准设备包括主校准***设备和副校准***设备;
获取所述主校准***设备的第一位置信息,以及获取所述副校准***设备的第二位置信息,并根据所述第一位置信息和第二位置信息确定所述副校准***设备在所述主校准***设备对应坐标系下的第三位置信息;
确定所述副分***设备在所述副校准***设备对应坐标系下的第四位置信息,并根据所述第三位置信息和第四位置信息确定所述副分***设备在所述主校准***设备对应坐标系下的第五位置信息;
确定所述主分***设备在所述主校准***设备对应坐标系下的第六位置信息,并根据所述第五位置信息和第六位置信息确定所述副分***在所述主分***对应坐标系下的位置信息。
2.根据权利要求1所述的方法,其特征在于,所述确定所述副分***设备在所述副校准***设备对应坐标系下的第四位置信息包括:
确定所述副分***设备的位置中心的投影与所述副校准***设备的第一设备的位置中心之间的第一距离,以及确定所述投影与所述副分***设备的位置中心之间的第二距离,其中,所述投影为所述副分***设备的位置中心在所述副校准***设备的第一设备的位置中心与所述副校准***设备的第二设备的位置中心之间连线上的投影;
根据所述第一距离和第二距离确定所述副分***设备在所述副校准***设备对应坐标系下的第四位置信息。
3.根据权利要求1所述的方法,其特征在于,所述确定所述主分***设备在所述主校准***设备对应坐标系下的第六位置信息包括:
确定所述主分***设备的位置中心的投影与所述主校准***设备的第一设备的位置中心之间的第三距离,以及确定所述投影与所述主分***设备的位置中心之间的第四距离,其中,所述投影为所述主分***设备的位置中心在所述主校准***设备的第一设备的位置中心与所述主校准***设备的第二设备的位置中心之间连线上的投影;
根据所述第三距离和第四距离确定所述主分***设备在所述主校准***设备对应坐标系下的第六位置信息。
4.根据权利要求1所述的方法,其特征在于,所述获取所述主校准***设备的第一位置信息,以及获取所述副校准***设备的第二位置信息,具体包括:
采用差分GNSS获取所述主校准***设备在经纬高坐标系下的第一位置信息,以及获取所述副校准***设备在经纬高坐标系下的第二位置信息。
5.根据权利要求4所述的方法,其特征在于,所述根据所述第一位置信息和第二位置信息确定所述副校准***设备在所述主校准***设备对应坐标系下的第三位置信息,具体包括:
根据所述主校准***设备在经纬高坐标系下的第一位置信息,以及所述副校准***设备在经纬高坐标系下的第二位置信息,确定所述副校准***设备在所述主校准***设备对应的东北天坐标系下的第三位置信息。
6.根据权利要求4所述的方法,其特征在于,在获取所述主校准***设备在经纬高坐标系下的第一位置信息以及获取所述副校准***设备在经纬高坐标系下的第二位置信息之后,所述方法还包括:
将所述第一位置信息和第二位置信息分别转换成在大地空间直角坐标系下的位置信息;
根据所述第一位置信息和第二位置信息在大地空间直角坐标系下的位置信息,确定所述副校准***设备在所述主校准***设备对应的东北天坐标系下的第三位置信息。
7.根据权利要求5或6所述的方法,其特征在于,在确定所述副分***设备在所述主分***设备对应的东北天坐标系下的位置信息之后,所述方法还包括:
将所述副分***设备在所述主分***设备对应的东北天坐标系下的位置信息转换成在所述主分***设备对应的惯导坐标系下的位置信息。
8.根据权利要求1所述的方法,其特征在于,在根据所述第五位置信息和第六位置信息确定所述副分***在所述主分***对应坐标系下的位置信息后,所述方法还包括:
根据所述副分***在所述主分***对应坐标系下的位置信息,对所述分***设备测得的所述副分***在所述主分***对应坐标系下的位置信息进行校准,得到所述副分***在所述主分***对应坐标系下的位置信息的误差范围。
9.根据权利要求8所述的方法,其特征在于,所述根据所述副分***在所述主分***对应坐标系下的位置信息,对所述分***设备测得的所述副分***在所述主分***对应坐标系下的位置信息进行校准,具体包括:
通过所述分***设备的秒脉冲数据与所述校准设备经过GNSS差分同步后的秒脉冲数据进行对比,对所述分***设备中的秒脉冲数据进行校准,并根据所述校准后的脉冲数据和所述副分***在所述主分***对应坐标系下的位置信息,对所述分***设备测得的所述副分***在所述主分***对应坐标系下的位置信息进行校准。
10.一种确定分布式协同***中副分***的位置信息的装置,其特征在于,该装置包括:
固定单元、获取单元、第一确定单元和第二确定单元,其中:
所述固定单元,用于固定分***设备和校准设备的位置,其中,所述分***设备包括主分***设备和副分***设备,所述校准设备包括主校准***设备和副校准***设备;
所述获取单元,用于获取所述主校准***设备的第一位置信息,以及获取所述副校准***设备的第二位置信息,并根据所述第一位置信息和第二位置信息确定所述副校准***设备在所述主校准***设备对应坐标系下的第三位置信息;
所述第一确定单元,用于确定所述副分***设备在所述副校准***设备对应坐标系下的第四位置信息,并根据所述第三位置信息和第四位置信息确定所述副分***设备在所述主校准***设备对应坐标系下的第五位置信息;
所述第二确定单元,用于确定所述主分***设备在所述主校准***设备对应坐标系下的第六位置信息,并根据所述第五位置信息和第六位置信息确定所述副分***在所述主分***对应坐标系下的位置信息。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610217778.7A CN105911576B (zh) | 2016-04-08 | 2016-04-08 | 确定分布式协同***中副分***的位置信息的方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610217778.7A CN105911576B (zh) | 2016-04-08 | 2016-04-08 | 确定分布式协同***中副分***的位置信息的方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105911576A CN105911576A (zh) | 2016-08-31 |
CN105911576B true CN105911576B (zh) | 2018-09-07 |
Family
ID=56744734
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610217778.7A Active CN105911576B (zh) | 2016-04-08 | 2016-04-08 | 确定分布式协同***中副分***的位置信息的方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105911576B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106878944B (zh) * | 2017-01-22 | 2020-04-24 | 上海乐相科技有限公司 | 一种校准定位基站坐标系的方法和定位校准装置 |
CN106851575B (zh) * | 2017-01-22 | 2020-04-24 | 上海乐相科技有限公司 | 一种统一定位基站坐标系的方法和定位校准装置 |
CN107085199B (zh) * | 2017-04-28 | 2020-05-05 | 北京无线电计量测试研究所 | 一种空间定位和时间同步方法和*** |
CN108872937B (zh) * | 2018-06-27 | 2020-11-13 | 上海乐相科技有限公司 | 一种校准定位基站坐标系的方法及装置 |
CN113108785B (zh) * | 2021-03-11 | 2022-06-10 | 中国电子科技集团公司第五十四研究所 | 一种面向同构imu的分布式协同互校准定位方法 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9037407B2 (en) * | 2010-07-12 | 2015-05-19 | Palantir Technologies Inc. | Method and system for determining position of an inertial computing device in a distributed network |
US9606217B2 (en) * | 2012-05-01 | 2017-03-28 | 5D Robotics, Inc. | Collaborative spatial positioning |
US8996311B1 (en) * | 2013-12-06 | 2015-03-31 | Novatel Inc. | Navigation system with rapid GNSS and inertial initialization |
CN104748746B (zh) * | 2013-12-29 | 2017-11-03 | 刘进 | 智能机姿态测定及虚拟现实漫游方法 |
-
2016
- 2016-04-08 CN CN201610217778.7A patent/CN105911576B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN105911576A (zh) | 2016-08-31 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105911576B (zh) | 确定分布式协同***中副分***的位置信息的方法及装置 | |
US6876926B2 (en) | Method and system for processing pulse signals within an inertial navigation system | |
CN106052718B (zh) | 一种基于pos设备与数字航测相机的校验方法及装置 | |
JP5084303B2 (ja) | 移動体姿勢計測装置 | |
CN104154928B (zh) | 一种适用于惯性平台内置式星敏感器的安装误差标定方法 | |
CN104165642B (zh) | 一种用于导航***航向角直接校正补偿方法 | |
CN103363949A (zh) | 一种卫星天线混合测量分析的方法 | |
EP3411725A1 (en) | A method and device for calibration of a three-axis magnetometer | |
US9916659B2 (en) | Operating device, operating method, and program therefor | |
CN108759798A (zh) | 一种高精度航天器精度测量的实现方法 | |
CN109631828B (zh) | 基于立方棱镜的相邻空间坐标系的坐标轴夹角的检测方法 | |
CN110133692B (zh) | 惯导技术辅助的高精度gnss动态倾斜测量***及方法 | |
CN103658721A (zh) | 一种离轴相机视轴的校准方法 | |
KR101107219B1 (ko) | 비행체의 항법 방법 및 이를 이용한 관성항법장치 필터 및 항법 시스템 | |
CN110275139B (zh) | 一种基于旋转式基元复用的超短基线定位***及方法 | |
CN109655080B (zh) | 一种数字式太阳敏感器在轨标定方法 | |
CN112097794B (zh) | 遥感卫星载荷平台标定方法及*** | |
CN112054304B (zh) | 一种阵列天线收发装置布设偏差校准补偿方法及*** | |
CN103954288B (zh) | 一种卫星姿态确定***精度响应关系确定方法 | |
CN113375693A (zh) | 一种地磁航向误差修正方法 | |
CN107064973A (zh) | 一种gnss坐标在可变焦镜头下的俯仰角补偿修正方法 | |
CN112633043B (zh) | 一种车道线确定方法、装置、电子设备及存储介质 | |
CN104101881A (zh) | 基于激光测距和mems/gps的目标导航测绘误差角估计方法 | |
Van Cranenbroeck et al. | Networking motorized total stations and GPS receivers for deformation measurements | |
JP2020008454A (ja) | 衛星測位システム及び衛星測位方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |