CN110573910B - 定位装置、定位系统、定位方法及存储介质 - Google Patents

定位装置、定位系统、定位方法及存储介质 Download PDF

Info

Publication number
CN110573910B
CN110573910B CN201880027909.2A CN201880027909A CN110573910B CN 110573910 B CN110573910 B CN 110573910B CN 201880027909 A CN201880027909 A CN 201880027909A CN 110573910 B CN110573910 B CN 110573910B
Authority
CN
China
Prior art keywords
station
positioning
antennas
integer value
antenna
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
Application number
CN201880027909.2A
Other languages
English (en)
Other versions
CN110573910A (zh
Inventor
户田裕行
藤泽奈绪美
中村拓
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Furuno Electric Co Ltd
Original Assignee
Furuno Electric Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Furuno Electric Co Ltd filed Critical Furuno Electric Co Ltd
Publication of CN110573910A publication Critical patent/CN110573910A/zh
Application granted granted Critical
Publication of CN110573910B publication Critical patent/CN110573910B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining 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/42Determining position
    • G01S19/43Determining position using carrier phase measurements, e.g. kinematic positioning; using long or short baseline interferometry
    • G01S19/44Carrier phase ambiguity resolution; Floating ambiguity; LAMBDA [Least-squares AMBiguity Decorrelation Adjustment] method
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining 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/53Determining attitude
    • G01S19/54Determining attitude using carrier phase measurements; using long or short baseline interferometry
    • G01S19/55Carrier phase ambiguity resolution; Floating ambiguity; LAMBDA [Least-squares AMBiguity Decorrelation Adjustment] method
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining 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/42Determining position
    • G01S19/45Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
    • G01S19/46Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being of a radio-wave signal type
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining 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/42Determining position
    • G01S19/45Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
    • G01S19/47Determining 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
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining 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/42Determining position
    • G01S19/51Relative positioning

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)

Abstract

课题在于,高速进行整数值偏差的决定。解决手段在于,定位装置具备浮点解运算部(61)以及整数值偏差决定部(62)。浮点解运算部(61)由第1站的一个以上的天线得到的载波相位与由第2站的多个天线分别得到的载波相位之间的载波相位差,且不使用第2站的姿态角地计算第2站的特定位置的浮点解。整数值偏差决定部(62)使用特定位置的浮点解、以及第2站的姿态角,决定载波相位差的整数值偏差。

Description

定位装置、定位系统、定位方法及存储介质
技术领域
本发明涉及使用定位信号的载波相位进行定位的定位装置、定位系统、定位方法及定位程序。
背景技术
以往,相对定位被利用作为高精度的定位方法。相对定位使用由多个天线分别接收到的定位信号的载波相位差来进行定位。作为这样的相对定位的一种,RTK(Real-timekinematic,实时动态)已被实用化。
通常,在RTK中,在基站与移动站分别具有一个天线,但在专利文献1以及专利文献2中记载了在RTK中使用多个天线的情况。
专利文献1、2的相对定位装置在基准站至少配置两个以上的天线(基准站天线),在移动站至少配置三个以上的天线(移动站天线)。专利文献1、2的相对定位装置使用各移动站天线相对于各基准站天线的位置,对特定的移动站天线的位置或者移动站的位置进行定位。
在先技术文献
专利文献
专利文献1:美国专利第8120527号说明书
专利文献2:美国专利第9035826号说明书
发明内容
发明所要解决的课题
然而,在专利文献1、2中记载的使用多个基准站天线以及多个移动站天线的方法中,存在利用载波相位差的相对定位运算所必须的初始整数值偏差的决定耗费时间的情况。若初始整数值偏差的决定耗费时间,则定位耗费时间。
因此,本发明的目的在于高速进行整数值偏差的决定。
用于解决课题的手段
本发明的定位装置具备浮点解运算部、姿态信息取得部及整数值偏差决定部。浮点解运算部使用由第1站的多个天线得到的载波相位与由第2站的一个以上的天线得到的载波相位之间的载波相位差,且不使用第1站的姿态信息地计算作为相对于第2站的相对位置的特定位置的浮点解,所述第2站与第1站分别设置。姿态信息取得部取得第1站的姿态信息。整数值偏差决定部使用特定位置的浮点解、以及第1站的姿态信息,决定载波相位的整数值偏差。
此外,本发明的定位装置具备浮点解运算部、姿态信息取得部及整数值偏差决定部。浮点解运算部使用由第1站的多个天线得到的载波相位,且不使用第1站的姿态信息地计算作为第1站的绝对位置的特定位置的浮点解。姿态信息取得部取得第1站的姿态信息。整数值偏差决定部使用特定位置的浮点解、以及第1站的姿态信息,决定载波相位的整数值偏差。
在这些构成中,即使在不知晓第1站的多个天线的相对位置关系即第1站的姿态角的状态下,浮点解也能够被计算。这里,在浮点解的计算中,无需载波相位差为整数这一特性。因此,即使不知晓相对位置关系,也能够得到进一步收敛的浮点解。
发明效果:
根据本发明,能够高速决定初始的整数值偏差,能够使利用了载波相位差的相对定位高速化。
附图说明
图1中(A)是本发明的第1实施方式的相对定位装置的功能框图,(B)是(A)所示的运算部的功能框图。
图2中(A)是表示包含本发明的第1实施方式的相对定位装置的相对定位系统中的多个天线与多个定位卫星的位置关系的一例的图,(B)是表示包含本发明的第1实施方式的相对定位装置的相对定位系统中的基线矢量的图。
图3是表示本发明的第1实施方式的相对定位的处理的流程图。
图4是表示本发明的第1实施方式的相对定位中的整数值偏差的决定处理的流程图。
图5是表示本发明的第1实施方式的相对定位中的浮点解的计算处理的流程图。
图6是表示本发明的第1实施方式的相对定位中的整数值偏差的决定处理的流程图。
图7是表示本发明的第1实施方式的整数值偏差的决定处理的更具体的处理的流程图。
图8是表示本发明的第2实施方式的相对定位的处理的流程图。
图9中(A)是本发明的第3实施方式的相对定位装置的第1方式的功能框图,(B)是本发明的第3实施方式的相对定位装置的第2方式的功能框图。
图10是表示本发明的实施方式的相对定位系统中的针对天线配置的其他方式例的图。
图11中(A)是本发明的第3实施方式的相对定位装置的功能框图,(B)是(A)所示的运算部的功能框图。
具体实施方式
参照附图说明本发明的第1实施方式的相对定位装置、相对定位系统、相对定位方法以及相对定位程序。图1中(A)是本发明的第1实施方式的相对定位装置的功能框图。图1中(B)是图1中(A)所示的运算部的功能框图。图2中(A)是表示包含本发明的第1实施方式的相对定位装置的相对定位系统中的多个天线与多个定位卫星的位置关系的一例的图。另外,在图2的(A)中,省略了表示针对定位卫星SV2的载波相位的虚线的图示。图2中(B)是表示包含本发明的第1实施方式的相对定位装置的相对定位系统中的基线矢量的图。
如图1中(A)所示,定位装置10具备定位用的天线21、22,接收部31、32,无线通信用的天线40,通信部41,观测值生成部50,以及运算部60。如图1中(B)所示,运算部60具备浮点解运算部61、整数值偏差决定部62及相对定位运算部63。接收部31、32,通信部41,观测值生成部50以及运算部60分别通过单独的硬件、以及由该硬件执行的各部的处理程序来实现。
定位装置10被用作相对定位系统的移动站。该相对定位系统具备与移动站不同的基站。移动站是本发明的“第1站”,基站是本发明的“第2站”。并且,相对定位系统例如采用RTK(实时动态)方式,定位装置10使用该RTK方式执行相对定位。
如图2中(A)、(B)所示,定位用的天线21、22以规定的位置关系配置。定位用的天线21接收来自定位卫星SV1、SV2的定位信号,并向接收部31输出。定位用的天线22接收来自定位卫星SV1、SV2的定位信号,并向接收部32输出。定位用的天线21、22接收来自包含定位卫星SV1、SV2的多个定位卫星的定位信号。此时,定位用的天线21、22接收来自至少四个共通的定位卫星的定位信号即可。另外,基站具备定位用的天线90。基站的定位用的天线90也与定位用的天线21、22共通地接收来自至少四个定位卫星的定位信号。
接收部31分别检测由天线21接收到的多个定位信号的载波相位,并向观测值生成部50输出。此时,接收部31检测由天线21接收到的多个定位信号各自的码伪距,并将其与载波相位一同输出。并且,接收部31将使用这些码伪距计算出的单点定位结果(位置坐标)与载波相位一同输出。另外,接收部31也可以输出码伪距的检测与单点定位结果的计算中的任一方。
接收部32分别检测由天线22接收到的多个定位信号的载波相位,并向观测值生成部50输出。此时,接收部32检测由天线22接收到的多个定位信号各自的码伪距,并将其与载波相位一同输出。并且,接收部32将使用这些码伪距计算出的单点定位结果(位置坐标)与载波相位一同输出。另外,接收部32也可以输出码伪距的检测与单点定位结果的计算中的任一方。
无线通信用的天线40接收来自基站的定位用数据信号。定位用数据信号中包含基站的天线90中的载波相位以及位置坐标。另外,若基站是能够移动的站,则位置坐标使用基站中的单点定位结果即可。
通信部41对由无线通信用的天线40接收到的定位用数据信号进行解调,将基站的天线90中的载波相位以及位置坐标向观测值生成部50输出。
观测值生成部50具备定位信息计算部51与姿态信息取得部52。
定位信息计算部51使用天线21的载波相位、以及天线90的载波相位,按每组定位卫星,计算对应于天线21与天线90的组的双相位差。即,定位信息计算部51计算图2中(A)、(B)示出的将天线90的中心点900设为起点且将天线21设为终点的基线矢量bb01所对应的双相位差。此外,定位信息计算部51使用天线22的载波相位、以及天线90的载波相位,按每组定位卫星,计算对应于天线22与天线90的组的双相位差。即,定位信息计算部51计算图2中(A)、(B)示出的将天线90的中心点900设为起点且将天线22设为终点的基线矢量bb02所对应的双相位差。定位信息计算部51将这些双相位差向运算部60输出。
此外,姿态信息取得部52使用天线21、22的载波相位差、并使用已知的方法计算天线21与天线22的相对位置关系即姿态角。姿态信息取得部52将姿态角向运算部60输出。
这里,关于姿态角的计算,与双相位差的计算相比,运算更复杂,与双相位差的计算相比,更耗费时间。因此,根据某时刻的载波相位计算姿态角并输出的时刻,与根据上述时刻的载波相位计算双相位差并输出的时刻相比较迟。
观测值生成部50分别对于双相位差与姿态角,与表示作为基础的载波相位的接收时刻的信息建立关联,并向运算部60输出。此外,观测值生成部50与表示该作为基础的载波相位的接收时刻的信息建立关联地、将上述天线21的单点定位结果以及天线22的单点定位结果向运算部60输出。
运算部60使用针对天线21与天线90的双相位差、针对天线22与天线90的双相位差、天线21、22的单点定位结果以及天线21与天线22的姿态角,执行能够针对天线装置20的特定位置200的相对定位运算。特定位置200是指俯视天线装置20时天线21的位置与天线22的位置的中点位置。另外,特定位置200不限于此,只要是天线装置20中的能够通过天线21的位置与天线22的位置的加权平均计算的位置即可。
更具体而言,如图1中(B)所示,运算部60的浮点解运算部61使用针对天线21与天线90的双相位差、针对天线22与天线90的载波相位的双相位差以及天线21、22的单点定位结果,来计算特定位置200的位置坐标以及整数值偏差的浮点解。
将针对天线90与天线21的双相位差设为将针对天线90与天线22的双相位差设为/>此外,将基于单点定位的天线21的位置设为b1,将基于单点定位的天线22的位置设为b2。另外,该位置b1、b2分别是将天线90的中心点900设为基准点的相对位置。此外,将方向余弦差矩阵设为ΔH。方向余弦差矩阵ΔH通过基于单点定位的天线21、22的位置、天线90的位置以及定位卫星SV1、SV2的位置并使用已知的方法来计算。另外,关于针对天线21的方向余弦差矩阵与针对天线22的方向余弦差矩阵,由于天线90与天线21、22的距离相比于天线90以及天线21、22与定位卫星SV1、SV2的距离足够短,因此能够通过相同的矩阵进行设定。
在该情况下,对于连结天线90与天线21的基线矢量bb01,以下的关系式成立。
在(式1)中,λ为载波的波长,为针对基线矢量bb01的整数值偏差、即针对天线90与天线21的组的整数值偏差。
同样,对于连结天线90与天线22的基线矢量bb02,以下的关系式成立。
在(式2)中,λ为载波的波长,为针对基线矢量bb02的整数值偏差、即针对天线90与天线22的组的整数值偏差。
这里,如上述那样,天线装置20的特定位置200是天线21的位置与天线22的位置的中点。因此,以天线90的中心点900设为基准的特定位置200的位置b0按下式进行定义。
b0≡(b1+b2)/2-(式3)
此外,针对连结天线90的中心点900与天线装置20的特定位置200的基线矢量bb0的整数值偏差a0按下式进行定义。
因此,根据(式1)、(式2)、(式3)、(式4),下式成立。
通过对该式适用卡尔曼滤波器,来推断计算特定位置200的位置b0的浮点解以及整数值偏差a0的浮点解。另外,推断方法不限于卡尔曼滤波器,也可以使用其他的推断方法。
这里,整数值偏差a0的浮点解不受整数这一限制。因此,即使不知晓天线21与天线22的相对位置关系、即姿态角,也能够使各浮点解(特定位置200的位置b0的浮点解以及整数值偏差a0的浮点解)收敛为更可靠且准确的值。并且,由于无需姿态角,浮点解的推断计算变得高速。
运算部60的整数值偏差决定部62使用来自姿态信息取得部52的姿态角、上述的浮点解b0、各双相位差来决定整数值偏差/>
将体坐标系中的以天线21为基准的天线22的相对位置设为ΔLb,将导航坐标系中的以天线21为基准的天线22的相对位置设为ΔLn。此外,将由体坐标系向导航坐标系的坐标变换矩阵设为Cnb。
在该情况下,下式成立。
ΔLn=Cnb·ΔLb-(式6)
根据(式1)、(式6),下式成立。
为针对天线90与天线21的组的整数偏差。
若将(式7)变形则成为(式8)。
此外,根据(式2)、(式6),下式成立。
是针对天线90与天线22的组的整数偏差。
若将(式9)变形则成为(式10)。
运算部60的整数值偏差决定部62对于(式8)、(式10),使用LAMBDA法并通过已知的方法来决定整数值偏差即,运算部60的整数值偏差决定部62计算整数值偏差/>的固定解。另外,运算部60的整数值偏差决定部62通过在上述(式6)中取得姿态角从而根据体坐标系的相对位置ΔLb计算导航坐标系的相对位置ΔLn,但也可以不使用姿态角,而是使用根据载波相位差得到的导航坐标系的相对位置ΔLn。
并且,运算部60的相对定位运算部63使用该整数值偏差 基于上述姿态角的天线21、22与特定位置200的上述相对位置关系,来计算特定位置200的固定解。
这样,通过使用本实施方式的构成以及处理,能够使整数值偏差的决定高速化,能够可靠且准确地决定整数值偏差。特别是,在本实施方式的构成中,即使需要决定整数值偏差的定位位置与天线的位置不同,也能够使整数值偏差的决定高速化,能够可靠且准确地决定整数值偏差。即,在以往的情况下,浮点解的计算也需要整数值偏差为整数这一限制。在该情况下,必须在浮点解的计算前计算姿态角,浮点解的计算时间延迟等待运算耗费时间的计算姿态角的时间量,进而整数值偏差的决定时间延迟。然而,在本实施方式的构成以及处理中,在浮点解的计算时即使不知晓姿态角,也能够计算浮点解,能够使浮点解的计算以及整数值偏差的决定高速化。
另外,在上述的说明中,示出了通过单独的功能部执行整数值偏差的决定以及相对定位运算的各处理的方式。然而,也可以将上述的整数值偏差的决定以及相对定位运算的各处理程序化并存储,通过运算处理装置读出并执行该程序。在该情况下,运算处理装置在每次被输入双相位差时,执行如下的各流程所示的处理。
图3是表示本发明的第1实施方式的相对定位的处理的流程图。
如图3所示,首先,运算处理装置取得上述的双相位差等的观测值(S101)。若整数值偏差已决定(S102:是),则运算处理装置使用该整数值偏差,计算天线装置20的特定位置200的相对定位、即特定位置200的固定解(S104)。
另一方面,若如初始的整数值偏差的决定等那样未决定整数值偏差(S102:否),则运算处理装置执行整数值偏差的决定处理(S103)。并且,运算处理装置使用已决定的整数值偏差,计算特定位置200的固定解(S104)。
接下来,对图3的整数值偏差的决定处理进行说明。图4是表示本发明的第1实施方式的相对定位中的整数值偏差的决定处理的流程图。
如图4所示,运算处理装置如上述那样不使用姿态角地计算浮点解(S201)。运算处理装置计算姿态角(S202)。运算处理装置使用该姿态角,如上述那样决定整数值偏差(S203)。另外,运算处理装置也可以对姿态角是否有效进行判定,在姿态角有效的情况下决定整数值偏差。姿态角是否有效的判定能够通过针对计算出的姿态角的已知的各种统计性的鉴别来实现。如果姿态角非有效,则运算处理装置不执行整数值偏差的决定。
接下来,对图4的浮点解的计算处理进行说明。图5是表示本发明的第1实施方式的相对定位中的浮点解的计算处理的流程图。
如图5所示,运算处理装置计算针对定位装置10(移动站)的多个天线21、22的双相位差(S301)。这里的双相位差是指基准站的天线90与天线21的双相位差、以及基准站的天线90与天线22的双相位差。
运算处理装置使用这些双相位差,计算基准站的天线90与移动站的天线装置20的特定位置200的双相位差(S302)。此外,运算处理装置根据天线21、22的单点定位结果、天线90的位置、以及定位卫星SV1、SV2的位置来计算方向余弦差矩阵(S303)。
如上述那样,运算处理装置对使用了双相位差以及方向余弦差矩阵的方程式适用卡尔曼滤波器,来推断计算针对特定位置的浮点解(S304)。
接下来,说明图4的整数值偏差的决定处理的更具体的处理。图6是表示本发明的第1实施方式的相对定位中的整数值偏差的决定处理的流程图。
如图6所示,运算处理装置计算定位装置10(移动站)的多个天线21、22间的双相位差(S401)。这里的双相位差是指与基准站的天线90无关地、以移动站的天线21、22中的某一个为基准的该天线21、22间的双相位差。
运算处理装置使用上述的方法计算天线21、22的姿态角(S402)。运算处理装置使用该姿态角,计算特定位置200相对于天线21、22的相对位置(S403)。
运算处理装置对于使用该相对位置、上述基准站的天线90与移动站的天线21之间的双相位差、基准站的天线90与移动站的天线22之间的双相位差、以及浮点解进行设定的上述方程式,通过适用LAMBDA法,来决定整数值偏差(S404)。
该整数值偏差的决定通过如下所示的处理执行。图7是表示本发明的第1实施方式的整数值偏差的决定处理的更具体的处理的流程图。
运算处理装置计算与特定位置200的双相位差对应的整数值偏差的浮点解以及协方差矩阵(S441)。运算处理装置使用这些整数值偏差的浮点解与协方差矩阵,并通过LAMBDA法制作整数值偏差的候选点(S442)。
运算处理装置根据各整数值偏差的候选点,计算特定位置200相对于天线90的相对位置(S443)。例如,运算处理装置使用成为最小范数的整数值偏差的候选点,来计算特定位置200的相对位置。
运算处理装置分别对于根据各候选点得到的特定位置200的相对位置,执行鉴别(S444)。作为鉴别,例如能够使用基于残差平方和的鉴别、或者基于范数之比的鉴别。基于残差平方和的鉴别通过残差平方和小于阈值,来判定鉴别的合格。基于范数之比的鉴别通过第2小的范数除以最小范数所得的比为阈值以上,来判定鉴别的合格。此外,运算处理装置也可以进行上述多个鉴别,在全部的鉴别合格的情况下,采用基于该候选点的特定位置200的相对位置。
接下来,参照附图说明本发明的第2实施方式的相对定位装置、相对定位系统、相对定位方法及相对定位程序。
在第2实施方式的相对定位装置、相对定位系统、相对定位方法及相对定位程序中,在固定解非有效、即鉴别不合格的情况下等,不输出相对定位的计算结果。然而,通过使用第2实施方式的方法,即使在固定解非有效的情况下,也能够替代地输出浮点解。
第2实施方式的相对定位装置以及相对定位系统的构成与第1实施方式的相对定位装置以及相对定位系统的构成相同,仅处理不同。因此,以下,仅具体说明与第1实施方式不同的处理之处。
图8是表示本发明的第2实施方式的相对定位的处理的流程图。
如图8所示,首先,运算处理装置取得上述的双相位差等的观测值(S501)。若整数值偏差已决定(S502:是),则运算处理装置使用该整数值偏差,计算天线装置20的特定位置200的相对定位、即特定位置200的固定解(S506)。
若如初始的整数值偏差的决定等那样,整数值偏差未决定(S502:否),则运算处理装置计算浮点解(S503)。
运算处理装置取得姿态角,若姿态角有效(S504:是),则执行整数值偏差的决定处理(S505)。然后,运算处理装置使用该整数值偏差,计算特定位置200的固定解(S506)。
运算处理装置使用上述的鉴别来判定固定解是否有效(S507)。若固定解有效(S507:是),则运算处理装置输出固定解(S508)。
若固定解非有效(S507:否)、或者姿态角非有效(S505:否),则运算处理装置判定浮点解的有效性(S509)。若固定解非有效而浮点解有效(S509:是),则运算处理装置输出浮点解(S510)。若浮点解非有效(S509:否),则运算处理装置输出通知相对定位结果的无效的无效标志(S511)。
通过进行这样的处理,根据定位卫星的配置、定位信号的接收状态等,即使在不能输出固定解的情况下,只要浮点解有效也能够输出浮点解。
接下来,参照附图说明本发明的第3实施方式的相对定位装置、相对定位系统、相对定位方法以及相对定位程序。图9中(A)是本发明的第3实施方式的相对定位装置的第1方式的功能框图。图9中(B)是本发明的第3实施方式的相对定位装置的第2方式的功能框图。
如图9中(A)所示,第3实施方式的定位装置10A、10B相对于第1实施方式的定位装置10,在追加了惯性传感器70这点、以及与之相应的处理的变更点上不同。定位装置10A、10B的其他构成与定位装置10相同,省略相同处的说明。
图9的(A)、(B)中的惯性传感器70例如具备角速度传感器。
在图9的(A)的定位装置10A中,惯性传感器70将角速度向观测值生成部50输出。观测值生成部50使用该角速度、以及定位信号的载波相位,来计算综合姿态角。综合姿态角是指例如通过载波相位或者使用了载波相位的角速度对惯性传感器70的角速度进行修正而计算出的姿态角。观测值生成部50将该姿态角向运算部60输出,运算部60使用该姿态角执行整数值偏差的决定处理以及相对定位。
在图9的(B)的定位装置10B中,惯性传感器70将角速度向运算部60输出。运算部60根据该角速度计算姿态角,并使用该姿态角执行整数值偏差的决定处理以及相对定位。
这样,也可以使用来自惯性传感器70的输出,计算姿态角。并且,在图9的(A)的定位装置10A中,由于能够获得高精度的姿态角,因此进一步提高了整数值偏差的决定处理的精度、相对定位的精度。此外,在图9的(B)的定位装置10B中,由于能够高速地取得姿态角,因此能够可靠且迅速地移向整数值偏差决定处理。
另外,在上述的说明中,示出了使用惯性传感器70的方式,但也可以代替惯性传感器70而使用地磁传感器。
另外,在上述的说明中,示出了基站的天线为一个、移动站的天线为两个的情况,但各站的天线数不限于此。图10是表示本发明的实施方式的相对定位系统中的针对天线的配置的其他方式例的图。
在图10中,基站的天线装置90C具备四个天线91、92、93、94。天线91、92、93、94在俯视天线装置90C时分别配置于正方形的四个角。移动站的天线装置20C具备四个天线21、22、23、24。天线21、22、23、24在俯视天线装置20C时分别配置于正方形的四个角。
在这样的构成中,进行移动站的天线装置20C的中心点200C相对于基站的天线装置90C的中心点900C的相对定位。中心点900C处于距离天线91、92、93、94等距离的位置,中心点900C的位置能够通过天线91、92、93、94的位置的平均值来定义。同样,中心点200C处于距离天线21、22、23、24等距离的位置,中心点200C的位置能够通过天线21、22、23、24的位置的平均值来定义。因此,能够适用上述的处理,能够不使用姿态角地计算浮点解,并能够使用该浮点解与姿态角来决定整数值偏差。并且,像这样使接收定位信号的天线数量增多,能够使观测值增多,提高了整数值偏差的决定精度。另外,基站的天线数与移动站的天线数也可以不相同。此外,成为决定整数值偏差的基线矢量的起点以及终点的点(基准点)也可以不是多个天线的配置的中心点。在该情况下,基准点通过多个天线的位置的加权平均来定义即可。
接下来,参照附图说明本发明的第3实施方式的定位装置、定位方法及定位程序。图11中(A)是本发明的第3实施方式的相对定位装置的功能框图,图11中(B)是图11中(A)所示的运算部的功能框图。
在上述的第1、第2实施方式中,对使用了基站的载波相位与移动站的载波相位之差(载波相位差)的RTK进行了说明。然而,对于仅使用了移动站的载波相位的PPP(精密单点定位,Precise Point Positioning),也能够适用上述的处理。在使用PPP的情况下,适用图11中(A)、(B)所示的构成即可。另外,在图11中(A)、(B)所示的构成中,对于与图1中(A)、(B)相同的构成,赋予与图1中(A)、(B)相同的附图标记,并省略该处的说明。
如图11中(A)所示,定位装置10C具备定位用的天线21、22,接收部31、32,观测值生成部50C以及运算部60C。观测值生成部50C具备定位信息计算部51C与姿态信息取得部52。如图11中(B)所示,运算部60C具备浮点解运算部61C、整数值偏差决定部62及单点定位运算部64。接收部31、32,通信部41,观测值生成部50C以及运算部60C分别通过单独的硬件或一个硬件以及由该硬件执行的各部的处理程序来实现。
定位信息计算部51C计算针对天线21、22的载波相位以及方向余弦。定位信息计算部51C将载波相位以及方向余弦向运算部60C输出。
浮点解运算部61C使用载波相位以及方向余弦,计算与天线21、22不同的特定位置200(参照图2的移动站)的单点定位的浮点解。此时,浮点解运算部61C通过将第1实施方式中的载波相位差以及方向余弦差置换为载波相位以及方向余弦的处理,来计算单点定位的浮点解。
整数值偏差决定部62使用该浮点解与姿态角决定整数值偏差。单点定位运算部64使用该整数值偏差、以及基于上述姿态角的天线21、22与特定位置200的相对位置关系,来计算特定位置200的固定解。
通过这样的构成,在使用了载波相位的单点定位中,整数值偏差的浮点解的推断计算变得高速。
另外,本实施方式的单点定位所使用的处理能够通过将上述的第1实施方式示出的处理中的载波相位差置换为载波相位,将方向余弦差置换为方向余弦来实现。
附图标记说明
10、10A、10B、10C:定位装置
20、20C:天线装置
21、22:天线
30:天线
31、32:接收部
40:天线
41:通信部
50、50C:观测值生成部
60、60C:运算部
61、61C:浮点解运算部
62:整数值偏差决定部
63:相对定位运算部
64:单点定位运算部
70:惯性传感器
90:天线
90C:天线装置
91:天线
200:特定位置
200C:中心点
900、900C:中心点
bb0:基线矢量
bb01:基线矢量
bb02:基线矢量
SV1:定位卫星
SV2:定位卫星

Claims (7)

1.一种定位装置,具备:
浮点解运算部,使用由第1站的多个天线得到的载波相位与由第2站的一个以上的天线得到的载波相位之间的载波相位差,且不使用所述第1站的姿态信息地计算作为相对于所述第2站的相对位置的特定位置的浮点解,所述第2站与所述第1站分别设置;
姿态信息取得部,取得所述第1站的所述姿态信息;以及
整数值偏差决定部,使用所述特定位置的浮点解、以及所述第1站的姿态信息,决定所述载波相位的整数值偏差。
2.如权利要求1所述的定位装置,具备:
相对定位运算部,使用所述特定位置的浮点解、以及所述整数值偏差,计算所述特定位置的固定解。
3.如权利要求1或2所述的定位装置,
所述第1站具备:
取得部,取得包含由所述第2站得到的载波相位的第2站数据;
所述浮点解运算部;以及
所述整数值偏差决定部。
4.如权利要求1或2所述的定位装置,
在所述第2站配置有多个天线,
所述浮点解运算部使用由所述第2站的多个天线分别得到的载波相位与由所述第1站的多个天线分别得到的载波相位之间的载波相位差,计算所述浮点解。
5.一种定位系统,
包含权利要求1至3中任一项所述的定位装置的构成,
所述第1站是移动站,
所述第2站是基准站。
6.一种定位方法,包括:
使用由第1站的多个天线得到的载波相位与由第2站的一个以上的天线得到的载波相位之间的载波相位差,且不使用所述第1站的姿态信息地计算作为相对于所述第2站的相对位置的特定位置的浮点解,所述第2站与所述第1站分别设置;
取得所述第1站的所述姿态信息;以及
使用所述特定位置的浮点解、以及所述第1站的姿态信息,决定所述载波相位的整数值偏差。
7.一种存储了定位程序的存储介质,该定位程序使运算处理装置执行如下处理:
使用由第1站的多个天线得到的载波相位与由第2站的一个以上的天线得到的载波相位之间的载波相位差,且不使用所述第1站的姿态信息地计算作为相对于所述第2站的相对位置的特定位置的浮点解,所述第2站与所述第1站分别设置;
取得所述第1站的所述姿态信息;以及
使用所述特定位置的浮点解、以及所述第1站的姿态信息,决定所述载波相位的整数值偏差。
CN201880027909.2A 2017-04-28 2018-03-27 定位装置、定位系统、定位方法及存储介质 Active CN110573910B (zh)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
JP2017089603 2017-04-28
JP2017-089603 2017-04-28
PCT/JP2018/012369 WO2018198641A1 (ja) 2017-04-28 2018-03-27 測位装置、測位システム、測位方法、および、測位プログラム

Publications (2)

Publication Number Publication Date
CN110573910A CN110573910A (zh) 2019-12-13
CN110573910B true CN110573910B (zh) 2023-11-28

Family

ID=63919665

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201880027909.2A Active CN110573910B (zh) 2017-04-28 2018-03-27 定位装置、定位系统、定位方法及存储介质

Country Status (4)

Country Link
US (1) US11366235B2 (zh)
JP (1) JP6750107B2 (zh)
CN (1) CN110573910B (zh)
WO (1) WO2018198641A1 (zh)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111337017A (zh) * 2020-04-20 2020-06-26 杭州微萤科技有限公司 一种aoa基站安装姿态的自动测定方法和装置
CN112099070A (zh) * 2020-08-24 2020-12-18 泰斗微电子科技有限公司 测向方法、测向装置、测向系统及基准站

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6259398B1 (en) * 2000-05-19 2001-07-10 Sri International Multi-valued variable ambiguity resolution for satellite navigation signal carrier wave path length determination
JP2001281317A (ja) * 2000-03-30 2001-10-10 Japan Radio Co Ltd 移動体姿勢計測システムおよび複数アンテナ配置構造
JP2002040124A (ja) * 2000-07-24 2002-02-06 Furuno Electric Co Ltd キャリア位相相対測位装置
JP2007071868A (ja) * 2005-08-08 2007-03-22 Furuno Electric Co Ltd キャリア位相相対測位装置及び方法
JP2007101484A (ja) * 2005-10-07 2007-04-19 Furuno Electric Co Ltd キャリア位相相対測位装置
JP2010197353A (ja) * 2009-02-27 2010-09-09 Mitsubishi Electric Corp 計算機装置
JP2013228237A (ja) * 2012-04-25 2013-11-07 Hitachi Zosen Corp 変位観測方法および変位観測システム

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8120527B2 (en) 2008-01-30 2012-02-21 Javad Gnss, Inc. Satellite differential positioning receiver using multiple base-rover antennas
US8587475B2 (en) * 2008-10-06 2013-11-19 Trimble Navigation Limited Position estimation methods and apparatus

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001281317A (ja) * 2000-03-30 2001-10-10 Japan Radio Co Ltd 移動体姿勢計測システムおよび複数アンテナ配置構造
US6259398B1 (en) * 2000-05-19 2001-07-10 Sri International Multi-valued variable ambiguity resolution for satellite navigation signal carrier wave path length determination
JP2002040124A (ja) * 2000-07-24 2002-02-06 Furuno Electric Co Ltd キャリア位相相対測位装置
JP2007071868A (ja) * 2005-08-08 2007-03-22 Furuno Electric Co Ltd キャリア位相相対測位装置及び方法
JP2007101484A (ja) * 2005-10-07 2007-04-19 Furuno Electric Co Ltd キャリア位相相対測位装置
JP2010197353A (ja) * 2009-02-27 2010-09-09 Mitsubishi Electric Corp 計算機装置
JP2013228237A (ja) * 2012-04-25 2013-11-07 Hitachi Zosen Corp 変位観測方法および変位観測システム

Also Published As

Publication number Publication date
CN110573910A (zh) 2019-12-13
WO2018198641A1 (ja) 2018-11-01
US11366235B2 (en) 2022-06-21
JP6750107B2 (ja) 2020-09-02
US20200132862A1 (en) 2020-04-30
JPWO2018198641A1 (ja) 2020-02-20

Similar Documents

Publication Publication Date Title
JP5301762B2 (ja) キャリア位相相対測位装置
JP4781313B2 (ja) マルチパス検出装置、測位装置、姿勢方位標定装置、マルチパス検出方法およびマルチパス検出プログラム
US10197681B2 (en) State calculating device, method of calculating state, and state calculating program
US20180245924A1 (en) Positioning apparatus and positioning method
CN111148020B (zh) 一种定位系统、方法、装置及计算机可读存储介质
US11525926B2 (en) System and method for position fix estimation using two or more antennas
JP6486234B2 (ja) 測位装置及び測位方法
US20130194078A1 (en) Mobile reading device, and method for locating an object that is marked with active transponder
US20190011570A1 (en) Gnss device location verification
CN110573910B (zh) 定位装置、定位系统、定位方法及存储介质
JP2002054946A (ja) 物体の姿勢検出装置および整数バイアス再決定方法
US10948292B2 (en) Sensor error calculating device, attitude angle calculating apparatus, method of calculating sensor error and method of calculating attitude angle
CN112505729B (zh) 确定卫星编号的方法、确定终端位置的方法、设备及介质
JP2006153816A (ja) 物体の方位および姿勢検出装置
US10877163B2 (en) Method and device for calculating attitude angle
KR100976965B1 (ko) 네비게이션 장치 및 이의 위치 결정 방법
US10976447B2 (en) Azimuth angle calculating device, and method of calculating azimuth angle
JP2008241079A (ja) 航法システム
JP5180447B2 (ja) キャリア位相相対測位装置及び方法
JP6546730B2 (ja) 衛星信号受信装置
KR20180083174A (ko) 전자전 지원 시스템(Warfare Support System)의 신호도래방위각 측정 장치 및 그 방법
JP6199679B2 (ja) 姿勢検出装置及びこれを備えた移動体、並びに、姿勢検出方法
JP6732926B2 (ja) 方位算出装置、方位算出方法、および方位算出プログラム
JP2021018218A (ja) 変位計測方法および変位計測システム
CN109633726A (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