WO2021064939A1 - 衛星信号受信装置及び位置測定装置 - Google Patents

衛星信号受信装置及び位置測定装置 Download PDF

Info

Publication number
WO2021064939A1
WO2021064939A1 PCT/JP2019/039115 JP2019039115W WO2021064939A1 WO 2021064939 A1 WO2021064939 A1 WO 2021064939A1 JP 2019039115 W JP2019039115 W JP 2019039115W WO 2021064939 A1 WO2021064939 A1 WO 2021064939A1
Authority
WO
WIPO (PCT)
Prior art keywords
satellite
antenna
phase difference
doppler
value
Prior art date
Application number
PCT/JP2019/039115
Other languages
English (en)
French (fr)
Inventor
知明 武輪
隆文 永野
Original Assignee
三菱電機株式会社
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 三菱電機株式会社 filed Critical 三菱電機株式会社
Priority to JP2021550879A priority Critical patent/JP7154433B2/ja
Priority to PCT/JP2019/039115 priority patent/WO2021064939A1/ja
Publication of WO2021064939A1 publication Critical patent/WO2021064939A1/ja

Links

Images

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/01Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/13Receivers
    • G01S19/22Multipath-related issues
    • 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/01Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/13Receivers
    • G01S19/24Acquisition or tracking or demodulation of signals transmitted by the system
    • G01S19/28Satellite selection

Definitions

  • the present invention relates to a satellite signal receiving device and a position measuring device.
  • GNSS Global Navigation Satellite System
  • a device for receiving a signal transmitted by each positioning satellite (hereinafter referred to as “satellite signal”) for receiving a signal transmitted by each positioning satellite (hereinafter referred to as “satellite signal”) for receiving a signal transmitted by each positioning satellite (hereinafter referred to as “satellite signal”) has been developed.
  • the satellite signal received by the satellite signal receiving device includes a signal corresponding to a so-called “direct wave” (hereinafter referred to as “direct wave signal”). Further, the satellite signal received by the satellite signal receiving device is a signal corresponding to a reflected wave or a diffracted wave by an object such as a building (hereinafter collectively referred to as "non-direct wave”) (hereinafter referred to as “non-direct wave signal”). .) Is included.
  • a measurement error occurs because the non-direct wave signal is used to measure the position of the moving body. From the viewpoint of suppressing the occurrence of such measurement error, it is preferable to exclude the non-direct wave signal from the measurement of the position of the moving body.
  • Patent Document 1 discloses a technique for determining whether or not an individual satellite signal is a non-direct wave signal (for example, paragraphs [0077] to [0113] and FIGS. 6 to 6 of Patent Document 1. See 9.).
  • a plurality of antennas including a first antenna and a second antenna
  • a plurality of positioning satellites transmit a plurality of satellite signals
  • the transmitted plurality of satellite signals are received by a plurality of antennas.
  • the positions of the plurality of positioning satellites are acquired and the positions of the vehicles are calculated.
  • the phase difference between the satellite signal received by the first antenna and the satellite signal received by the second antenna is acquired.
  • the Doppler frequency related to each of the received plurality of satellite signals is acquired.
  • the absolute direction of arrival of radio waves with respect to the vehicle is calculated for each of the plurality of positioning satellites. Further, based on the acquired phase difference, the relative arrival direction of the radio wave with respect to the vehicle is estimated for each of the plurality of positioning satellites. Further, the absolute traveling direction of the vehicle is estimated based on the acquired Doppler frequency.
  • the absolute arrival direction of radio waves with respect to the vehicle is estimated for each of the plurality of positioning satellites. For each of the plurality of positioning satellites, the estimated absolute arrival direction and the calculated absolute arrival direction are compared. Thereby, it is determined whether or not each of the plurality of received satellite signals is a non-direct wave signal.
  • Patent Document 1 the relative arrival direction of radio waves to a vehicle is based on the installation direction of a plurality of antennas in the vehicle (hereinafter referred to as "antenna installation direction") (Patent Document 1). See paragraph [0047], etc.).
  • antenna installation direction the installation direction of a plurality of antennas in the vehicle.
  • Patent Document 1 there is a problem that the above determination cannot be made unless the traveling direction of the vehicle matches the antenna installation direction.
  • the above determination cannot be made when the vehicle is stopped or when the vehicle is traveling in a direction different from the antenna installation direction.
  • the present invention has been made to solve the above problems, and individual satellite signals can be transmitted regardless of whether or not the moving body is moving and regardless of the moving direction of the moving body.
  • the purpose is to determine whether or not it is a direct wave signal.
  • the satellite signal receiving device of the present invention includes an antenna that receives a plurality of satellite signals transmitted by a plurality of positioning satellites, an antenna direction estimation unit that calculates an antenna velocity vector estimated value related to the antenna, and a plurality of antennas.
  • the Doppler residual calculation unit that calculates the Doppler frequency theoretical value using the antenna velocity vector estimated value and calculates the Doppler residual that indicates the difference between the Doppler frequency theoretical value and the Doppler frequency observed value
  • the Doppler threshold setting unit for setting the Doppler threshold for comparison with respect to the Doppler residual, and by comparing the Doppler residual with the Doppler threshold, each of the plurality of satellite signals is a direct wave signal. It is provided with a determination unit for determining whether or not the frequency is high.
  • each satellite signal is a direct wave signal regardless of whether or not the moving body is moving and regardless of the moving direction of the moving body. It can be determined whether or not.
  • FIG. 1 It is a block diagram which shows the main part of the satellite signal receiving apparatus which concerns on Embodiment 1.
  • FIG. It is a block diagram which shows the hardware configuration of the satellite signal determination apparatus in the satellite signal receiving apparatus which concerns on Embodiment 1.
  • FIG. It is a block diagram which shows the other hardware configuration of the satellite signal determination apparatus in the satellite signal receiving apparatus which concerns on Embodiment 1.
  • FIG. It is a flowchart which shows the operation of the satellite signal determination apparatus in the satellite signal receiving apparatus which concerns on Embodiment 1.
  • FIG. 1 It is explanatory drawing which shows the relationship of the satellite position vector, the satellite velocity vector, the antenna position vector, the antenna velocity vector, and the line-of-sight vector. It is a flowchart which shows the detailed operation of the Doppler residual calculation part in the satellite signal receiving apparatus which concerns on Embodiment 1.
  • FIG. It is a flowchart which shows the detailed operation of the Doppler threshold value setting part in the satellite signal receiving apparatus which concerns on Embodiment 1.
  • FIG. It is a flowchart which shows the detailed operation of the determination part in the satellite signal receiving apparatus which concerns on Embodiment 1.
  • FIG. It is a block diagram which shows the main part of the satellite signal receiving apparatus which concerns on Embodiment 2.
  • FIG. 1 It is explanatory drawing which shows the relationship of the satellite position vector, the satellite velocity vector, the antenna position vector, the antenna velocity vector, and the line-of-sight vector.
  • FIG. It is a flowchart which shows the operation of the satellite signal determination apparatus in the satellite signal receiving apparatus which concerns on Embodiment 2.
  • FIG. It is a flowchart which shows the detailed operation of the antenna posture estimation part in the satellite signal receiving apparatus which concerns on Embodiment 2.
  • FIG. It is explanatory drawing which shows the correspondence relation of the phase difference between antennas, the distance between antennas, the baseline vector and the signal arrival angle.
  • It is a flowchart which shows the detailed operation of the phase difference residual calculation part in the satellite signal receiving apparatus which concerns on Embodiment 2.
  • FIG. It is a flowchart which shows the detailed operation of the phase difference threshold setting part in the satellite signal receiving apparatus which concerns on Embodiment 2.
  • FIG. It is a flowchart which shows the detailed operation of the determination part in the satellite signal receiving apparatus which concerns on Embodiment 2.
  • FIG. It is a block diagram which shows the main part of the satellite signal receiving apparatus which concerns on Embodiment 3. It is a flowchart which shows the operation of the satellite signal determination apparatus in the satellite signal receiving apparatus which concerns on Embodiment 3.
  • FIG. It is a flowchart which shows the detailed operation of the reception timing correction part in the satellite signal receiving apparatus which concerns on Embodiment 3.
  • FIG. It is a block diagram which shows the main part of the position measuring apparatus which concerns on Embodiment 4.
  • FIG. It is a block diagram which shows the hardware structure of the position measuring apparatus which concerns on Embodiment 4.
  • FIG. 1 It is a block diagram which shows the other hardware configuration of the position measuring apparatus which concerns on Embodiment 4.
  • FIG. It is a flowchart which shows the operation of the satellite signal determination device and the position measurement part in the position measurement device which concerns on Embodiment 4.
  • FIG. It is a block diagram which shows the main part of another position measuring apparatus which concerns on Embodiment 4.
  • FIG. It is a block diagram which shows the main part of another position measuring apparatus which concerns on Embodiment 4.
  • FIG. 1 It is a block diagram which shows the main part of another position measuring apparatus which concerns on Embodiment 4.
  • the positions of these antennas are referred to as “antenna positions”.
  • the position vector related to these antennas is referred to as “antenna position vector”.
  • the velocity vector related to these antennas is referred to as “antenna velocity vector”.
  • the estimated value of the antenna speed vector is referred to as “antenna speed vector estimated value”.
  • the arrangement of a plurality of positioning satellites is referred to as "satellite arrangement”. That is, the satellite arrangement indicates the position of each of the plurality of positioning satellites. Further, the position vector related to each of the plurality of positioning satellites is referred to as “satellite position vector”. Further, the velocity vector related to each of the plurality of positioning satellites is referred to as “satellite velocity vector”.
  • the observed value of the carrier phase related to each of the plurality of satellite signals is referred to as “carrier wave”. It is called “phase observation value”.
  • the unit of the carrier phase is the wave number.
  • the observed value of the signal-to-noise ratio related to each of the plurality of satellite signals is referred to as “signal-to-noise ratio observed value”.
  • Doppler frequency observed value the observed value of the Doppler frequency related to each of the plurality of satellite signals.
  • the amount of change in the Doppler frequency related to each of the plurality of satellite signals is referred to as "the amount of Doppler shift”.
  • the theoretical value of the Doppler frequency related to each of the plurality of satellite signals is referred to as the “Doppler frequency theoretical value”.
  • Doppler residual the difference between the Doppler frequency observed value and the Doppler frequency theoretical value for each of the plurality of satellite signals.
  • Doppler threshold value the threshold value for comparison with respect to the Doppler residual.
  • each of the plurality of satellite signals and two of the plurality of antennas are used.
  • the difference between the carrier phase of the satellite signal received by one antenna and the carrier phase of the satellite signal received by the other antenna is called “inter-antenna phase difference”.
  • the observed value of the phase difference between the antennas related to each of the plurality of satellite signals is referred to as the “observed value of the phase difference between the antennas”.
  • the theoretical value of the phase difference between the antennas related to each of the plurality of satellite signals is referred to as the "theoretical value of the phase difference between the antennas”.
  • phase difference threshold value the threshold value for comparison with respect to the phase difference residual.
  • a vector indicating the line-of-sight direction by one antenna or a plurality of antennas for each of a plurality of positioning satellites is referred to as a "line-of-sight vector”.
  • the unit vector of the line-of-sight vector is called “unit line-of-sight vector”.
  • a vector connecting the antenna position vector related to one antenna and the antenna position vector related to the other antenna is called a "baseline vector”.
  • the unit vector of the baseline vectors is called a "unit baseline vector”.
  • the estimated value of the baseline vector is referred to as "baseline vector estimated value”.
  • the angle of the line-of-sight vector with respect to the horizontal plane is referred to as “satellite elevation angle”.
  • the identification information related to each of the plurality of positioning satellites is referred to as "identification information”.
  • the identification information includes, for example, information indicating the type of the corresponding positioning satellite and information indicating the PRN (Pseudo Random Noise) number of the corresponding positioning satellite.
  • one or more satellite signals out of the plurality of satellite signals are directly delivered.
  • it is a wave signal
  • one or more positioning satellites corresponding to the one or more satellite signals are referred to as "direct wave receiving satellites”.
  • one or more satellite signals among the plurality of satellite signals are non-direct wave signals
  • one or more positioning satellites corresponding to the one or more satellite signals are referred to as “non-direct wave”. It is called "reception satellite”.
  • one of the plurality of satellite signals is a candidate for a direct wave signal.
  • the above satellite signal is called a "direct wave candidate signal”.
  • one or more positioning satellites that are candidates for the direct wave receiving satellite among the plurality of positioning satellites are referred to as "direct wave receiving candidate satellites”.
  • phase difference threshold table a table showing the correspondence between a plurality of Doppler thresholds and a plurality of satellite elevation angle-signal-to-noise ratio pairs.
  • the code formed by adding the symbol “ ⁇ ” above the character “x” may be described as “x ( ⁇ )”. Further, a code formed by adding a symbol “ ⁇ ” above the character “x” may be described as “x ( ⁇ )”. In addition, a code formed by adding the symbol “ ⁇ ” and the symbol “ ⁇ ” above the character “x” may be described as “x ( ⁇ , ⁇ )”. In addition, a code having a symbol “ ⁇ ” above the character “ ⁇ ” may be described as “ ⁇ ( ⁇ )”. Further, a code formed by adding the symbol “ ⁇ ” above the character “f” may be described as “f ( ⁇ )”. Further, a symbol “ ⁇ ( ⁇ )” may be described by adding a symbol “ ⁇ ” above the character “ ⁇ ”.
  • N is an arbitrary integer of 2 or more.
  • FIG. 1 is a block diagram showing a main part of the satellite signal receiving device according to the first embodiment.
  • the satellite signal receiving device according to the first embodiment will be described with reference to FIG.
  • the mobile body 1 is composed of, for example, a vehicle, a ship, an aircraft, or a mobile information terminal.
  • the mobile body 1 has an antenna 2.
  • the antenna 2 receives the transmitted N satellite signals SS 1 to SS N.
  • Antenna 2 and outputs the received satellite signals SS 1 ⁇ SS N satellite signal processing unit 11.
  • the satellite signals SS 1 to SS N between the positioning satellites PS 1 to PS N and the antenna 2 are composed of radio waves.
  • the satellite signals SS 1 ⁇ SS N between the antenna 2 and the satellite signal processing unit 11 is composed of a high-frequency signal. That is, the antenna 2 converts radio waves into high-frequency signals.
  • the individual positioning satellites PS 1 to PS N are composed of GNSS satellites. Specifically, for example, the individual positioning satellite PS 1 ⁇ PS N, GPS ( Global Positioning System) satellites, GLONASS (Global Navigation Satellite System) satellite, BeiDou satellite, Galileo satellite or QZSS (Quasi-Zenith Satellite System) satellite It is composed of.
  • GPS Global Positioning System
  • GLONASS Global Navigation Satellite System
  • BeiDou satellite BeiDou satellite
  • Galileo satellite Galileo satellite
  • QZSS Quadasi-Zenith Satellite System
  • the number of satellite signals SS 1 ⁇ SS N received by the antenna 2 i.e., the number of satellite signals SS 1 ⁇ SS positioning satellite N transmitted the PS 1 ⁇ PS N
  • the total number of the positioning satellites contained in the GNSS The position of each positioning satellite included in the GNSS, the position of the moving body 1 on the earth, and the like. That is, the value of N varies depending on these factors.
  • Satellite signal processing unit 11 is for acquiring the satellite signals SS 1 ⁇ SS N outputted by the antenna 2. Satellite signal processing unit 11, with respect to the acquired satellite signals SS 1 ⁇ SS N, processing performed by a conventional GNSS receiver (satellite acquisition process, including satellite tracking processing and the demodulation processing.) And similar It executes the process. As a result, satellite arrangement, carrier phase observation value, Doppler frequency observation value, signal-to-noise ratio observation value, and the like are detected. The satellite signal processing unit 11 outputs data including the detected satellite arrangement (hereinafter referred to as “navigation message”). Further, the satellite signal processing unit 11 outputs data including the detected carrier wave phase observation value, Doppler frequency observation value, and signal-to-noise ratio observation value (hereinafter referred to as “observation data”).
  • observation data data including the detected carrier wave phase observation value, Doppler frequency observation value, and signal-to-noise ratio observation value
  • the satellite signal processing unit 11 uses the navigation message and the observation data to execute the same positioning process as the positioning process executed by the normal GNSS receiver. As a result, the antenna position is detected.
  • the positioning process executed by the satellite signal processing unit 11 is, for example, independent positioning, RTK (Real Time Kinetic) positioning, or PPP (Precise Point Positioning) positioning.
  • the satellite signal processing unit 11 outputs data including the detected antenna position (hereinafter referred to as “antenna position data”).
  • satellite signal processing unit 11 may be collectively referred to as "satellite signal processing".
  • the antenna direction estimation unit 12 acquires the navigation message, observation data, and antenna position data output by the satellite signal processing unit 11.
  • the antenna direction estimation unit 12 calculates an antenna velocity vector estimated value by using the acquired navigation message, observation data, and antenna position data.
  • the antenna direction estimation unit 12 outputs the calculated antenna velocity vector estimated value.
  • antenna direction estimation process the processes executed by the antenna direction estimation unit 12 may be collectively referred to as "antenna direction estimation process". The details of the antenna direction estimation process will be described later with reference to the flowchart of FIG.
  • the Doppler residual calculation unit 13 acquires the navigation message, observation data, and antenna position data output by the satellite signal processing unit 11, and also acquires the antenna velocity vector estimated value output by the antenna direction estimation unit 12. is there. Doppler residual calculating section 13, and calculates the acquired navigation message, observation data, using the antenna position data and antenna velocity vector estimate, a Doppler residual according to each of the satellite signals SS 1 ⁇ SS N is there. The Doppler residual calculation unit 13 outputs the calculated Doppler residual.
  • Doppler residual calculation process the processes executed by the Doppler residual calculation unit 13 may be collectively referred to as "Doppler residual calculation process". The details of the Doppler residual calculation process will be described later with reference to the flowchart of FIG.
  • the Doppler threshold setting unit 14 acquires navigation messages, observation data, and antenna position data output by the satellite signal processing unit 11. Doppler threshold setting unit 14 is configured such acquired navigation message, using the observed data and antenna position data, it sets the Doppler threshold according to each of the satellite signals SS 1 ⁇ SS N. The Doppler threshold setting unit 14 outputs the set Doppler threshold.
  • Doppler threshold setting process the processes executed by the Doppler threshold setting unit 14 may be collectively referred to as "Doppler threshold setting process". The details of the Doppler threshold setting process will be described later with reference to the flowchart of FIG. 7.
  • the determination unit 15 acquires the Doppler residual output by the Doppler residual calculation unit 13, and also acquires the Doppler threshold value output by the Doppler threshold value setting unit 14. Determination unit 15 uses the acquired Doppler residuals and Doppler residuals, each of the satellite signals SS 1 ⁇ SS N is one that determines whether the direct wave signal. That is, the determination unit 15 determines whether or not each of the positioning satellites PS 1 to PS N is a direct wave receiving satellite. The determination unit 15 outputs identification information indicating a direct wave receiving satellite based on the result of the determination.
  • determination processing the processes executed by the determination unit 15 may be collectively referred to as “determination processing”. Details of such determination processing will be described later with reference to the flowchart of FIG.
  • the main part of the satellite signal determination device 100 is composed of the satellite signal processing unit 11, the antenna direction estimation unit 12, the Doppler residual calculation unit 13, the Doppler threshold setting unit 14, and the determination unit 15.
  • the satellite signal determination device 100 is provided on, for example, the mobile body 1.
  • the antenna 2 and the satellite signal determination device 100 constitute a main part of the satellite signal receiving device 200.
  • the satellite signal determination device 100 has a processor 21 and a memory 22.
  • the memory 22 stores programs for realizing the functions of the satellite signal processing unit 11, the antenna direction estimation unit 12, the Doppler residual calculation unit 13, the Doppler threshold setting unit 14, and the determination unit 15.
  • the processor 21 reads out and executes such a program, the functions of the satellite signal processing unit 11, the antenna direction estimation unit 12, the Doppler residual calculation unit 13, the Doppler threshold setting unit 14, and the determination unit 15 are realized.
  • the satellite signal determination device 100 has a processing circuit 23.
  • the functions of the satellite signal processing unit 11, the antenna direction estimation unit 12, the Doppler residual calculation unit 13, the Doppler threshold setting unit 14, and the determination unit 15 are realized by the dedicated processing circuit 23.
  • the satellite signal determination device 100 has a processor 21, a memory 22, and a processing circuit 23 (not shown).
  • some of the functions of the satellite signal processing unit 11, the antenna direction estimation unit 12, the Doppler residual calculation unit 13, the Doppler threshold setting unit 14, and the determination unit 15 are realized by the processor 21 and the memory 22.
  • the remaining functions are realized by the dedicated processing circuit 23.
  • the processor 21 is composed of one or a plurality of processors.
  • processors for example, a CPU (Central Processing Unit), a GPU (Graphics Processing Unit), a microprocessor, a microcontroller, or a DSP (Digital Signal Processor) is used.
  • CPU Central Processing Unit
  • GPU Graphics Processing Unit
  • DSP Digital Signal Processor
  • the memory 22 is composed of one or a plurality of non-volatile memories.
  • the memory 22 is composed of one or more non-volatile memories and one or more volatile memories. That is, the memory 22 is composed of one or a plurality of memories.
  • the individual memory uses, for example, a semiconductor memory or a magnetic disk. More specifically, each volatile memory uses, for example, a RAM (Random Access Memory).
  • the individual non-volatile memory is, for example, a ROM (Read Only Memory), a flash memory, an EPROM (Erasable Programmable Read Only Memory), an EEPROM (Ectrically Easy Erasable Programmory) drive, or a hard drive using a hard drive, a hard drive, or a hard drive. Is.
  • the processing circuit 23 is composed of one or a plurality of digital circuits. Alternatively, the processing circuit 23 is composed of one or more digital circuits and one or more analog circuits. That is, the processing circuit 23 is composed of one or a plurality of processing circuits.
  • the individual processing circuits are, for example, ASIC (Application Special Integrated Circuit), PLD (Programmable Logic Device), FPGA (Field Programmable Gate Array), FPGA (Field Program Is.
  • the operation of the satellite signal receiving device 200 will be described focusing on the operation of the satellite signal determining device 100.
  • the satellite signal processing unit 11 executes satellite signal processing (step ST1).
  • the antenna direction estimation unit 12 executes the antenna direction estimation process (step ST2).
  • the Doppler residual calculation unit 13 executes the Doppler residual calculation process (step ST3).
  • the Doppler threshold setting unit 14 executes the Doppler threshold setting process (step ST4).
  • the determination unit 15 executes the determination process (step ST5).
  • the antenna direction estimation unit 12 acquires the navigation message, observation data, and antenna position data output by the satellite signal processing unit 11 (step ST11).
  • the satellite position vector x i and the satellite velocity vector x ( .) I are detected based on the satellite arrangement included in the acquired navigation message.
  • the satellite velocity vector x (.) I is detected, for example, by time differentiation with respect to the satellite arrangement. Further, based on the Doppler frequency observed value f i dop_A_obs included in the obtained observation data, Doppler shift amount ⁇ f i dop_A is detected. Further, the antenna position vector x A is detected based on the antenna position included in the acquired antenna position data.
  • FIG. 5 shows the relationship between the satellite position vector x i , the satellite velocity vector x ( ⁇ ) i , the antenna position vector x A , the antenna velocity vector x ( ⁇ ) A, and the line-of-sight vector.
  • the following equation (1) holds for the Doppler shift amount ⁇ f i dop_A.
  • f car represents the center frequency of the carrier wave according to each of the satellite signals SS 1 ⁇ SS N.
  • c indicates the speed of light.
  • the vector value (u in the formula) in the above formula (2) is defined by the following formula (3).
  • the scalar value (S in the formula) in the above formula (2) is defined by the following formula (4).
  • the antenna direction estimation unit 12 uses the detected satellite position vector x i , satellite velocity vector x (.) I , Doppler shift amount ⁇ f i dop_A, and antenna position vector x A to obtain the above equation (2).
  • the antenna velocity vector x ( ⁇ ) A is calculated by the minimum square method based on the method.
  • the antenna velocity vector estimated value x ( ⁇ , ⁇ ) A is calculated (step ST12).
  • the antenna direction estimation unit 12 outputs the calculated antenna velocity vector estimated value x (., ⁇ ) A (step ST13).
  • the Doppler residual calculation unit 13 acquires the navigation message, observation data, and antenna position data output by the satellite signal processing unit 11. Further, the Doppler residual calculation unit 13 acquires the antenna velocity vector estimated value x (., ⁇ ) A output by the antenna direction estimation unit 12 (step ST21).
  • the satellite position vector x i and the satellite velocity vector x ( .) I are detected based on the satellite arrangement included in the acquired navigation message.
  • the satellite velocity vector x (.) I is detected, for example, by time differentiation with respect to the satellite arrangement.
  • the antenna position vector x A is detected based on the antenna position included in the acquired antenna position data.
  • the Doppler residual calculation unit 13 determines the acquired antenna velocity vector estimated value x ( ⁇ , ⁇ ) A , the detected satellite position vector x i , the satellite velocity vector x ( ⁇ ) i, and the antenna position vector x. with a, and calculates the Doppler frequency theoretical value f ( ⁇ ) i dop_A according to each of the satellite signals SS 1 ⁇ SS N (step ST22). At this time, the Doppler residual calculation unit 13 calculates the Doppler frequency theoretical value f ( ⁇ ) i dop_A by the following equation (5).
  • a Doppler residual calculating unit 13 uses the Doppler frequency observed value f i dop_A_obs contained the calculated Doppler frequency theory f ( ⁇ ) to i Dop_A and the acquired observation data, satellite signals SS 1 ⁇ calculating a Doppler residual f i dop_A_resi according to each SS N (step ST23). At this time, Doppler residual calculating section 13 calculates the Doppler residual f i dop_A_resi by the following equation (6).
  • a Doppler residual calculating section 13 outputs the calculated Doppler residual f i dop_A_resi (step ST24).
  • the Doppler threshold setting unit 14 acquires the navigation message, observation data, and antenna position data output by the satellite signal processing unit 11 (step ST31).
  • the satellite position vector x i is detected.
  • the antenna position vector x A is detected based on the acquired antenna position data.
  • the Doppler threshold setting unit 14 uses the detected satellite position vector x i and the antenna position vector x A, calculated satellite elevation angle ele according to each of the positioning satellite PS 1 ⁇ PS N (step ST32).
  • the Doppler threshold setting unit 14 uses the signal-to-noise ratio observed value SNR contained in the calculated satellite elevation ele and the acquired observed data, Doppler threshold according to each of the satellite signals SS 1 ⁇ SS N f i thre (ele, SNR) to set the (step ST33).
  • the Doppler threshold setting unit 14 has a Doppler threshold table.
  • Doppler threshold setting unit 14 for each of the positioning satellite PS 1 ⁇ PS N (i.e. for each of the satellite signals SS 1 ⁇ SS N), satellite elevation ele and signals of a plurality of Doppler threshold contained in the Doppler threshold table
  • One Doppler threshold corresponding to the satellite elevation-signal-to-noise ratio pair by signal-to-noise ratio observed value SNR is selected.
  • the Doppler threshold setting unit 14 outputs the set Doppler threshold f i thre (ele, SNR) ( step ST34).
  • the Doppler threshold setting unit 14 may select two or more Doppler thresholds corresponding to the satellite elevation-signal-to-noise ratio pair. Then, the Doppler threshold setting unit 14 executes interpolation processing for the selected two or more Doppler threshold, may be used to set the Doppler threshold f i thre (ele, SNR) .
  • the determination unit 15 acquires the Doppler residual f i dop_A_resi output by Doppler residual calculating section 13.
  • the determination unit 15 for each of the satellite signals SS 1 ⁇ SS N, compares the acquired Doppler residual f i dop_A_resi the acquired Doppler threshold f i thre (ele, SNR) (step ST42) .
  • each of the satellite signals SS 1 ⁇ SS N is determined whether a direct wave signal.
  • the determination unit 15 determines that the corresponding satellite signal SS i is the direct wave signal. In other words, in this case, the determination unit 15, the corresponding positioning satellite PS i is assumed to be direct wave receiving satellite.
  • the determination unit 15 determines that the corresponding satellite signal SS i is a non-direct wave signal. In other words, in this case, the determination unit 15 determines that the corresponding positioning satellite PS i is a non-direct wave receiving satellite.
  • the determination unit 15 outputs identification information indicating each direct wave receiving satellite based on the determination result in step ST42 (step ST43).
  • the satellite signal determination device 100 by comparing the Doppler residuals f i dop_A_resi Doppler threshold f i thre (ele, SNR) and, if each of the satellite signals SS 1 ⁇ SS N is the direct wave signal Judge whether or not. As a result, the determination can be made regardless of whether or not the moving body 1 is moving. Further, the determination can be made regardless of the moving direction of the moving body 1. As a result, for example, the determination can be made even when the moving body 1 is moving in a curve.
  • the Doppler threshold table is generated as follows, for example.
  • the same plurality of positioning satellites and positioning satellite PS 1 ⁇ PS N sends each a plurality of satellite signals similar to the satellite signal SS 1 ⁇ SS N.
  • the one antenna receives the plurality of satellite signals.
  • the same processing as the satellite signal processing by the satellite signal processing unit 11 the same processing as the antenna direction estimation processing by the antenna direction estimation unit 12, and the Doppler by the Doppler residual calculation unit 13.
  • the same process as the residual calculation process is executed.
  • the positioning processing time indicated by the internal clock (hereinafter referred to as "internal time”.) And with respect to the satellite signals SS 1 ⁇ SS N satellite signal processing unit 11 is executed As a result, the difference from the time calculated (hereinafter referred to as “positioning time") (hereinafter referred to as "clock error”) may be large.
  • positioning time the time calculated (hereinafter referred to as "clock error”.
  • clock error the Doppler shift amount ⁇ f i dop_A_obs the following is detected.
  • the Doppler shift amount ⁇ f i dop_A_obs is obtained by superimposing the time derivative amount ⁇ (.) A (t) on the Doppler shift amount ⁇ f i dop_A. Therefore, the Doppler shift amount ⁇ f i dop_A_obs is expressed by the following equation (7).
  • the antenna direction estimation unit 12 considers that the time derivative ⁇ ( ⁇ ) A (t) is unknown, and calculates the antenna velocity vector x ( ⁇ ) A by the least squares method based on the above equation (8). To do. As a result, the antenna velocity vector estimated value x ( ⁇ , ⁇ ) A is calculated. That is, even when the accuracy of the internal clock of the satellite signal processing unit 11 is low, the antenna velocity vector estimated value x ( ⁇ , ⁇ ) A can be calculated.
  • the Doppler residual calculating section 13 calculates the Doppler frequency theoretical value f ( ⁇ ) i dop_A_obs according to each of the satellite signals SS 1 ⁇ SS N. Then, a Doppler residual calculating section 13, by the following equation (10), to calculate a Doppler residual f i dop_A_resi according to each of the satellite signals SS 1 ⁇ SS N. Accordingly, even if the internal clock accuracy of a satellite signal processing unit 11 is low, it is possible to calculate the Doppler residual f i dop_A_resi.
  • the antenna direction estimation unit 12 may use the so-called "robust estimation" for calculating the antenna velocity vector estimated value.
  • the antenna direction estimation unit 12 may use the RANSAC (Random Sample Consensus) method, the minimum median method, or the M estimation method.
  • the RANSAC method is used as follows. That is, the antenna direction estimation unit 12 randomly selects k positioning satellites from the N positioning satellites PS 1 to PS N (k ⁇ N). The antenna direction estimation unit 12 calculates the antenna velocity vector estimated value by the least squares method based on the k satellite signals corresponding to the selected k positioning satellites. Using the calculated antenna velocity vector estimated value, the Doppler residuals for each of the N positioning satellites PS 1 to PS N are calculated. These Doppler residuals are calculated by, for example, the Doppler residual calculation unit 13. The antenna direction estimation unit 12 acquires the calculated Doppler residual.
  • the antenna direction estimation unit 12 adopts the antenna velocity vector estimated value at the time when the number of Doppler residuals equal to or less than the predetermined value among the N Doppler residuals is the largest, based on the acquired Doppler residuals for the predetermined times. To do.
  • the minimum median method is used as follows. That is, the antenna direction estimation unit 12 selects k pieces of positioning satellites of the N positioning satellite PS 1 ⁇ PS N randomly. The antenna direction estimation unit 12 calculates the antenna velocity vector estimated value by the least squares method based on the k satellite signals corresponding to the selected k positioning satellites. By using the calculated antenna velocity vector estimated value, Doppler residuals are calculated according to each of the N positioning satellite PS 1 ⁇ SS N. These Doppler residuals are calculated by, for example, the Doppler residual calculation unit 13. The antenna direction estimation unit 12 acquires the calculated Doppler residual.
  • the antenna direction estimation unit 12 adopts the antenna velocity vector estimation value at the time when the median value of N Doppler residuals is the largest, based on the acquired Doppler residuals for a predetermined number of times.
  • the M estimation method is used as follows. That is, the antenna direction estimation unit 12 uses the following equation (11) instead of the above equation (2).
  • the following equation (11) is formed by adding a weight W dop to the determinant according to the above equation (2).
  • the antenna direction estimation unit 12 calculates the antenna velocity vector by the least squares method based on the above equation (11), and the Doppler residual calculation unit 13 uses the calculated antenna velocity vector to calculate N satellite signals SS 1 to.
  • the process of calculating the Doppler residuals for each of the SS Ns and the process of updating the weight W dop by the antenna direction estimation unit 12 based on the calculated Doppler residuals are repeatedly executed a predetermined time.
  • the update of the weight W dop is, for example, by Tukey's Biglight estimation method. At this time, the weight W dop becomes small when it is given to the observation value related to the positioning satellite corresponding to the large Doppler residual, and when it is given to the observation value related to the positioning satellite corresponding to the small Doppler residual. Is something that grows.
  • the influence of the observed value including a large error can be reduced.
  • the error of the antenna velocity vector estimated value can be reduced.
  • the antenna direction estimation unit 12 may calculate the antenna velocity vector estimated value by the least squares method. In this case, observation data at a single time is used. On the other hand, the antenna direction estimation unit 12 may calculate the antenna velocity vector estimated value by the Kalman filter. In this case, observation data at multiple times is used.
  • the antenna velocity vector is modeled as a first-order Markov process by the following equation (12).
  • equation (12) is used in the equation of state.
  • indicates a time constant.
  • ⁇ x ( ⁇ ) A indicates a process noise vector regarding the direction of the antenna 2.
  • the antenna velocity vector is included in the state quantity vector, but also the antenna position may be included in the state quantity vector. Further, the time derivative of the clock error or the like may be included in the state quantity vector.
  • Determining unit 15 if each of the satellite signals SS 1 ⁇ SS N is in place to determine whether the direct wave signal (i.e., each positioning satellite PS 1 ⁇ PS N is a direct wave received satellite not (Instead of determining whether or not the antenna 2 is installed), it may be used to determine whether or not the antenna 2 is installed in an open sky environment. Further, the determination unit 15 may output a signal indicating the result of the determination (hereinafter referred to as “determination result signal”) instead of outputting the identification signal indicating each direct wave receiving satellite. good.
  • the Doppler residual calculator 13 after calculating the Doppler residual f i dop_A_resi according to each of the satellite signals SS 1 ⁇ SS N, calculates the sum of squares RSS dop these Doppler residuals f i dop_A_resi.
  • the Doppler residual calculation unit 13 outputs the calculated sum of squares RSS dop to the determination unit 15.
  • the sum of squares RSS dop is calculated by the following formula (13).
  • Doppler threshold setting unit 14 the Doppler threshold f i thre (ele, SNR) according to each of the satellite signals SS 1 ⁇ SS N After setting, the sum of the squares of these Doppler threshold f i thre (ele, SNR) Calculate RSS dop_thre.
  • the Doppler threshold setting unit 14 outputs the calculated sum of squares RSS dop_thre to the determination unit 15.
  • the sum of squares RSS dop_thre is calculated by the following equation (14).
  • the determination unit 15 acquires the sum of squares RSS dop output by the Doppler residual calculation unit 13, and also acquires the sum of squares RSS dop_thre output by the Doppler threshold value setting unit 14. The determination unit 15 compares the acquired sum of squares RSS dop with the acquired sum of squares RSS dop_thre.
  • the determination unit 15 determines that the antenna 2 is installed in the open sky environment.
  • the determination unit 15 determines that the antenna 2 is installed in an environment different from the open sky environment (hereinafter referred to as "non-open sky environment").
  • the satellite signal reception apparatus 200 includes an antenna 2 for receiving a plurality of satellite signals SS 1 ⁇ SS N sent respectively by a plurality of positioning satellites PS 1 ⁇ PS N, antenna direction estimation unit 12 for calculating the antenna velocity vector estimated value of the antenna 2, for each of the plurality of satellite signals SS 1 ⁇ SS N, and calculates the Doppler frequency theoretical value using the antenna velocity vector estimate, and Doppler residual calculating section 13 for calculating a Doppler residual that indicates a difference between the Doppler frequency theoretical value and the Doppler frequency observed values, for each of the plurality of satellite signals SS 1 ⁇ SS N, Doppler for comparison of Doppler residuals a Doppler threshold setting unit 14 for setting a threshold value, by comparing the Doppler residuals and Doppler threshold, each determination section for determining whether or not a direct wave signal of a plurality of satellite signals SS 1 ⁇ SS N 15 And. As a result, the determination can be made regardless of whether or not
  • the satellite signal reception apparatus 200 uses a plurality of satellite signals SS 1 ⁇ SS N, satellite constellation according to a plurality of positioning satellites PS 1 ⁇ PS N, Doppler frequency observations, a plurality of satellite signals SS 1 each signal-to-noise ratio observed value according to the ⁇ SS N, and includes a satellite signal processing unit 11 for detecting the antenna position of the antenna 2, the antenna direction estimation unit 12, the satellite constellation, the Doppler frequency observations and antenna position Use to calculate the antenna velocity vector estimate. This makes it possible to calculate the antenna velocity vector estimate.
  • the antenna direction estimation unit 12 calculates the antenna velocity vector estimated value by the least squares method or the Kalman filter. This makes it possible to calculate the antenna velocity vector estimate.
  • the antenna direction estimation unit 12 calculates the antenna velocity vector estimated value by the RANSAC method, the minimum median method, or the M estimation method. That is, the antenna direction estimation unit 12 calculates the antenna velocity vector estimated value by robust estimation. Thus, even if it contains many Hijika transmitted wave signal to the satellite signal SS 1 ⁇ SS N, it is possible to accurately calculate the antenna velocity vector estimate.
  • the Doppler threshold setting unit 14 is a plurality of Doppler thresholds included in the Doppler threshold table.
  • One or more Doppler thresholds corresponding to the satellite elevation angle and the signal-to-noise ratio observed value are selected, and the Doppler threshold is set based on the selected one or more Doppler thresholds.
  • the Doppler threshold value can be set to an appropriate value according to the satellite elevation angle and the signal-to-noise ratio observed value.
  • FIG. 9 is a block diagram showing a main part of the satellite signal receiving device according to the second embodiment.
  • the satellite signal receiving device according to the second embodiment will be described with reference to FIG.
  • the same blocks as those shown in FIG. 1 are designated by the same reference numerals, and the description thereof will be omitted.
  • the moving body 1 has a plurality of antennas 2.
  • the antenna 2a is composed of a plurality of antennas 2.
  • the satellite signal determination device 100a has a plurality of satellite signal processing units 11 having a one-to-one correspondence with the plurality of antennas 2.
  • the satellite signal processing unit 11a is composed of a plurality of satellite signal processing units 11. Each of the plurality of satellite signal processing units 11 executes the same satellite signal processing as that described in the first embodiment. That is, the satellite signal processing unit 11a executes the same satellite signal processing as that described in the first embodiment.
  • the satellite signal determination device 100a has two satellite signal processing units 11_A and 11_B. That is, the satellite signal processing units 11_A and 11_B have a one-to-one correspondence with the antennas 2_A and 2_B.
  • the antenna attitude estimation unit 16 acquires the navigation message, observation data, and antenna position data output by the satellite signal processing unit 11a.
  • the antenna attitude estimation unit 16 calculates the baseline vector estimated values related to the antennas 2_A and 2_B by using the acquired navigation message, observation data, and antenna position data.
  • the antenna attitude estimation unit 16 outputs the calculated baseline vector estimated value.
  • antenna attitude estimation process the processes executed by the antenna attitude estimation unit 16 may be collectively referred to as "antenna attitude estimation process". The details of the antenna attitude estimation process will be described later with reference to the flowchart of FIG.
  • the phase difference residual calculation unit 17 acquires the navigation message, observation data, and antenna position data output by the satellite signal processing unit 11a, and also acquires the baseline vector estimated value output by the antenna attitude estimation unit 16. is there. Phase residual calculating section 17, and calculates the acquired navigation message, observation data, using the antenna position data and baseline vector estimate, a phase difference residuals relating to each of the satellite signals SS 1 ⁇ SS N Is. The phase difference residual calculation unit 17 outputs the calculated phase difference residual.
  • phase difference residual calculation process the processes executed by the phase difference residual calculation unit 17 may be collectively referred to as "phase difference residual calculation process". The details of the phase difference residual calculation process will be described later with reference to the flowchart of FIG.
  • the phase difference threshold setting unit 18 acquires navigation messages, observation data, and antenna position data output by the satellite signal processing unit 11. Phase difference threshold setting section 18 is for the acquired navigation message, using the observed data and antenna position data, setting the phase difference threshold according to each of the satellite signals SS 1 ⁇ SS N. The phase difference threshold setting unit 18 outputs the set phase difference threshold.
  • phase difference threshold setting process the processes executed by the phase difference threshold setting unit 18 may be collectively referred to as "phase difference threshold setting process". The details of the phase difference threshold setting process will be described later with reference to the flowchart of FIG.
  • the determination unit 15a includes the Doppler residual output by the Doppler residual calculation unit 13, the Doppler threshold value output by the Doppler threshold value setting unit 14, the phase difference residual output by the phase difference residual calculation unit 17, and the phase difference.
  • the phase difference threshold value output by the threshold value setting unit 18 is acquired.
  • Determination unit 15a the acquired Doppler residuals, which Doppler threshold, by using the phase difference residuals and phase difference threshold, each of the satellite signals SS 1 ⁇ SS N to determine whether a direct wave signal Is. That is, the determination unit 15a determines whether or not each of the positioning satellites PS 1 to PS N is a direct wave receiving satellite.
  • the determination unit 15a outputs identification information indicating each direct wave receiving satellite based on the result of the determination.
  • determination processing the processes executed by the determination unit 15a may be collectively referred to as “determination processing". Details of such determination processing will be described later with reference to the flowchart of FIG.
  • satellite signal processing unit 11a By satellite signal processing unit 11a, antenna direction estimation unit 12, Doppler residual calculation unit 13, Doppler threshold setting unit 14, determination unit 15a, antenna attitude estimation unit 16, phase difference residual calculation unit 17, and phase difference threshold setting unit 18. ,
  • the main part of the satellite signal determination device 100a is configured.
  • the satellite signal determination device 100a is provided on the moving body 1, for example.
  • the antenna 2a and the satellite signal determination device 100a constitute a main part of the satellite signal receiving device 200a.
  • the hardware configuration of the main part of the satellite signal determination device 100a is the same as that described with reference to FIG. 2 in the first embodiment. Therefore, illustration and description will be omitted. That is, the satellite signal processing unit 11a, the antenna direction estimation unit 12, the Doppler residual calculation unit 13, the Doppler threshold value setting unit 14, the determination unit 15a, the antenna attitude estimation unit 16, the phase difference residual calculation unit 17, and the phase difference threshold value setting unit.
  • Each function of 18 may be realized by the processor 21 and the memory 22, or may be realized by the dedicated processing circuit 23.
  • the satellite signal processing unit 11a executes satellite signal processing (step ST1a).
  • the antenna direction estimation unit 12 executes the antenna direction estimation process (step ST2).
  • the Doppler residual calculation unit 13 executes the Doppler residual calculation process (step ST3).
  • the Doppler threshold setting unit 14 executes the Doppler threshold setting process (step ST4).
  • the antenna attitude estimation unit 16 executes the antenna attitude estimation process (step ST6).
  • the phase difference residual calculation unit 17 executes the phase difference residual calculation process (step ST7).
  • the phase difference threshold setting unit 18 executes the phase difference threshold setting process (step ST8).
  • the determination unit 15a executes the determination process (step ST5a).
  • the antenna attitude estimation unit 16 acquires the navigation message, observation data, and antenna position data output by the satellite signal processing unit 11a (step ST51).
  • the satellite position vector x i is detected.
  • the antenna position vector x A is detected based on the antenna position included in the acquired antenna position data.
  • the antenna attitude estimation section 16 uses the carrier phase observations included in the acquired observational data, and calculates the phase difference observations phi i AB between the antennas according to each of the satellite signals SS 1 ⁇ SS N (Ste ST52). That is, the antenna posture estimation unit 16, for each of the satellite signals SS 1 ⁇ SS N, satellite signal processor 11_A, by taking the difference between the carrier phase observations included in the observed data outputted at the same time by 11_B, Calculate the phase difference observation value ⁇ i AB between the antennas.
  • the distance between the antennas 2_A and 2_B is referred to as “distance between antennas”.
  • the radio wave corresponding to each of the satellite signals SS 1 ⁇ SS N an angle of arrival direction with respect to the baseline vector referred to as “signal arrival angle”.
  • FIG. 12 shows the correspondence between the antenna-to-antenna phase difference ( ⁇ i AB in the figure), the antenna-to-antenna distance d, the baseline vector x uAB, and the signal arrival angle ⁇ related to the satellite signal SS i.
  • indicates the wavelength of the carrier wave in the satellite signal SS i.
  • the unit eye vector for positioning satellite PS i by the antenna 2_A can be regarded as equal to the unit line-of-sight vector for positioning satellite PS i by the antenna 2_B.
  • the above equation (15) is an approximate equation based on such fiction.
  • cos ⁇ is equal to the inner product of the unit baseline vector and the fictitious unit line-of-sight vector. Therefore, the following equation (16) holds.
  • the antenna attitude estimation unit 16 uses the detected satellite position vector x i, the antenna position vector x A , and the calculated inter-antenna phase difference observation value ⁇ i AB to obtain the minimum based on the above equation (18).
  • the baseline vector x uAB is calculated by the square method.
  • the baseline vector estimated value x ( ⁇ ) uAB is calculated (step ST53).
  • the antenna attitude estimation unit 16 outputs the calculated baseline vector estimated value x ( ⁇ ) uAB (step ST54).
  • phase difference residual calculation unit 17 the details of the phase difference residual calculation process by the phase difference residual calculation unit 17 will be described.
  • the phase difference residual calculation unit 17 acquires the navigation message, observation data, and antenna position data output by the satellite signal processing unit 11a. Further, the phase difference residual calculation unit 17 acquires the baseline vector estimated value x ( ⁇ ) uAB output by the antenna attitude estimation unit 16 (step ST61).
  • the satellite position vector x i is detected.
  • the antenna position vector x A is detected based on the antenna position included in the acquired antenna position data.
  • the phase difference residual calculating section 17 calculated using the carrier-phase observations included in the observation data the acquired inter-antenna phase difference observations phi i AB according to each of the satellite signals SS 1 ⁇ SS N (Step ST62).
  • the method of calculating the inter-antenna phase difference observation value ⁇ i AB by the phase difference residual calculation unit 17 is the same as the method of calculating the inter-antenna phase difference observation value ⁇ i AB by the antenna attitude estimation unit 16.
  • the phase difference residual calculation unit 17 uses the detected satellite position vector x i, the antenna position vector x A , and the acquired baseline vector estimated value x ( ⁇ ) uAB to display the satellite signals SS 1 to SS.
  • the theoretical value ⁇ ( ⁇ ) i AB between the antennas related to each of N is calculated (step ST63).
  • the phase difference residual calculation unit 17 calculates the theoretical value ⁇ ( ⁇ ) i AB of the phase difference between the antennas by the following equation (19).
  • the phase difference residual calculation unit 17 uses the calculated inter-antenna phase difference theoretical value ⁇ ( ⁇ ) i AB and the above-calculated inter-antenna phase difference observation value ⁇ i AB to use the satellite signals SS 1 to The phase difference residual ⁇ i resi for each of the SS N is calculated (step ST64). At this time, the phase difference residual calculation unit 17 calculates the phase difference residual ⁇ i resi by the following equation (20).
  • phase difference residual calculation unit 17 outputs the calculated phase difference residual ⁇ i risi (step ST65).
  • phase difference threshold setting process by the phase difference threshold setting unit 18 will be described with reference to the flowchart of FIG.
  • the phase difference threshold setting unit 18 acquires the navigation message, observation data, and antenna position data output by the satellite signal processing unit 11a (step ST71).
  • the satellite position vector x i is detected.
  • the antenna position vector x A is detected based on the acquired antenna position data.
  • the phase difference threshold setting unit 18 uses the detected satellite position vector x i and the antenna position vector x A, calculated satellite elevation angle ele according to each of the positioning satellite PS 1 ⁇ PS N (step ST72) ..
  • the phase difference threshold setting unit 18 uses the signal-to-noise ratio observed value SNR contained in the calculated satellite elevation ele and the acquired observed data, position according to each of the satellite signals SS 1 ⁇ SS N retardation threshold ⁇ i thre (ele, SNR) sets a (step ST73).
  • phase difference threshold setting unit 18 has a phase difference threshold table.
  • Phase difference threshold setting unit 18, for each of the positioning satellite PS 1 ⁇ PS N i.e. for each of the satellite signals SS 1 ⁇ SS N
  • satellite elevation angle of the plurality of phase difference threshold included in the phase difference threshold table Select one phase difference threshold corresponding to the satellite elevation-signal-to-noise ratio pair by ele and signal-to-noise ratio observations SNR.
  • Phase difference threshold setting section 18, using one of the phase difference threshold is the selected phase difference threshold ⁇ i thre (ele, SNR) .
  • phase difference threshold setting section 18 the set phase difference threshold ⁇ i thre (ele, SNR) and outputs a (step ST74).
  • phase difference threshold setting unit 18 may select two or more phase difference thresholds corresponding to the satellite elevation angle-signal-to-noise ratio pair. Then, the phase difference threshold setting unit 18 executes interpolation processing for the selected two or more phase difference threshold may be used to set the phase difference threshold ⁇ i thre (ele, SNR) ..
  • the determination unit 15a a Doppler residual f i dop_A_resi output by Doppler residual calculating section 13, the Doppler threshold f i thre output by Doppler threshold setting unit 14 (ele, SNR), the phase difference residual calculator output by 17 phase difference residual phi i resi, and output by the phase difference threshold setting section 18 phase difference threshold ⁇ i thre (ele, SNR) to get (step ST81).
  • each of the satellite signals SS 1 ⁇ SS N is compared with the acquired phase difference residual phi i resi is the acquired phase difference threshold ⁇ i thre (ele, SNR) (step ST82).
  • each of the satellite signals SS 1 ⁇ SS N is determined whether a direct wave candidate signals.
  • the determination unit 15a determines that the corresponding satellite signal SS i are direct waves received candidate satellites.
  • the determination unit 15a determines that the corresponding satellite signal SS i is a non-direct wave signal. That is, in this case, the determination unit 15a determines that the corresponding positioning satellite PS i is a non-direct wave receiving satellite.
  • the determination unit 15a based on the judgment result in step ST82, compared for each direct wave candidate signals, the Doppler threshold f i thre (ele, SNR) of the Doppler residual f i dop_A_resi which is the acquired is the acquisition and (Step ST83). As a result, it is determined whether or not each direct wave candidate signal is a direct wave signal.
  • the determination unit 15a determines that the corresponding satellite signal SS i is the direct wave signal. In other words, in this case, the determination unit 15a, the corresponding positioning satellite PS i is assumed to be direct wave receiving satellite.
  • the determination unit 15a determines that the corresponding satellite signal SS i is a non-direct wave signal. In other words, in this case, the determination unit 15a determines that the corresponding positioning satellite PS i is a non-direct wave receiving satellite.
  • the determination unit 15a outputs an identification signal indicating each direct wave receiving satellite based on the determination result in step ST83 (step ST84).
  • the satellite signal determining apparatus 100a the Doppler residual f i dop_A_resi Doppler threshold f i thre (ele, SNR) as well as compared to the phase difference threshold retardation residual ⁇ i resi ⁇ i thre (ele , by comparing the SNR), each of the satellite signals SS 1 ⁇ SS N determines whether the direct wave signal. As a result, the determination can be made regardless of whether or not the moving body 1 is moving. Further, the determination can be made regardless of the moving direction of the moving body 1. As a result, for example, the determination can be made even when the moving body 1 is moving in a curve.
  • the moving body 1 when the moving body 1 is composed of a vehicle, the reflected wave from the surface portion parallel to the traveling road surface may be received by the antenna 2a. Even in such a case, each of the satellite signals SS 1 ⁇ SS N can be accurately determined whether the direct wave signal.
  • phase difference threshold table is generated as follows, for example.
  • the same plurality of positioning satellites and positioning satellite PS 1 ⁇ PS N sends each a plurality of satellite signals similar to the satellite signal SS 1 ⁇ SS N.
  • the two antennas receive the plurality of satellite signals.
  • the same processing as the satellite signal processing by the satellite signal processing unit 11a, the same processing as the antenna attitude estimation processing by the antenna attitude estimation unit 16, and the phase difference residual calculation unit 17 are performed.
  • the same process as the phase difference residual calculation process is executed.
  • the antenna attitude estimation unit 16 may use the constraint condition shown in the following equation (21). As a result, a more accurate solution can be obtained. Further, in this case, the baseline vector estimated value x ( ⁇ ) uAB is calculated by the following equation (22).
  • the antenna attitude estimation unit 16 may use the following constraint conditions when calculating the baseline vector x uAB by the least squares method based on the above equation (18). That is, the antenna attitude estimation unit 16 may use the geometrical relationship between the moving direction of the antenna 2a and the installation positions of the antennas 2_A and 2_B as the constraint condition between the baseline vector and the antenna velocity vector.
  • the constraint condition when the antenna 2a is moving linearly that is, when the moving body 1 is moving linearly
  • indicates the angle of the antenna 2a in the moving direction with respect to the baseline vector.
  • the antenna attitude estimation unit 16 may use the robust estimation for calculating the baseline vector estimated value. Specifically, for example, the antenna attitude estimation unit 16 may use the RANSAC method, the minimum median method, or the M estimation method.
  • the RANSAC method is used as follows. That is, the antenna posture estimation unit 16, a k-number of positioning satellites of the N positioning satellite PS 1 ⁇ SS N randomly selected (k ⁇ N).
  • the antenna attitude estimation unit 16 calculates the baseline vector estimated value by the least squares method based on the k satellite signals corresponding to the selected k positioning satellites. By using the calculated baseline vector estimate, the phase difference residuals relating to each of the N positioning satellite PS 1 ⁇ SS N are calculated. These phase difference residuals are calculated by, for example, the phase difference residual calculation unit 17.
  • the antenna attitude estimation unit 16 acquires the calculated phase difference residual.
  • N phase difference residuals are acquired for a predetermined number of times.
  • the antenna attitude estimation unit 16 is based on the acquired phase difference residuals for the predetermined times, and the baseline vector estimated value at the time when the number of the phase difference residuals equal to or less than the predetermined value among the N phase difference residuals is the largest. Is adopted.
  • the minimum median method is used as follows. That is, the antenna posture estimation unit 16 selects k pieces of positioning satellites of the N positioning satellite PS 1 ⁇ SS N randomly. The antenna attitude estimation unit 16 calculates the baseline vector estimated value by the least squares method based on the k satellite signals corresponding to the selected k positioning satellites. By using the calculated baseline vector estimate, the phase difference residuals relating to each of the N positioning satellite PS 1 ⁇ SS N are calculated. These phase difference residuals are calculated by, for example, the phase difference residual calculation unit 17. The antenna attitude estimation unit 16 acquires the calculated phase difference residual.
  • N phase difference residuals are acquired for a predetermined number of times.
  • the antenna attitude estimation unit 16 adopts the baseline vector estimation value at the time when the median value of N phase difference residuals is the largest, based on the acquired phase difference residuals for the predetermined times.
  • the M estimation method is used as follows. That is, the antenna attitude estimation unit 16 uses the following equation (24) instead of the above equation (18).
  • the following equation (24) is formed by adding a weight W phase to the determinant according to the above equation (18).
  • the antenna attitude estimation unit 16 calculates the baseline vector estimated value by the least squares method based on the above equation (24), and the phase difference residual calculation unit 17 uses the calculated baseline vector estimated value to generate N satellite signals.
  • the process of calculating the phase difference residuals for each of SS 1 to SS N and the process of updating the weight vector by the antenna attitude estimation unit 16 based on the calculated phase difference residuals are repeatedly executed a predetermined time.
  • the update of the weight W phase is, for example, by Tukey's Biweight estimation method. At this time, the weight W phase becomes smaller when it is given to the observed value related to the positioning satellite corresponding to the large phase difference residual, and is given to the observed value related to the positioning satellite corresponding to the small phase difference residual. When it happens, it gets bigger.
  • the influence of the observed value including a large error can be reduced.
  • the error of the baseline vector estimate can be reduced.
  • the antenna attitude estimation unit 16 may calculate the baseline vector estimated value by the least squares method. In this case, observation data at a single time is used. On the other hand, the antenna attitude estimation unit 16 may calculate the baseline vector estimated value by the Kalman filter. In this case, observation data at multiple times is used.
  • the baseline vector is modeled as a first-order Markov process by the following equation (25).
  • equation (25) is used in the equation of state.
  • ⁇ phase indicates a time constant.
  • ⁇ xuAB indicates a process noise vector related to the unit baseline vector.
  • the unit baseline vector is included in the state quantity vector, but also the antenna position may be included in the state quantity vector. Further, the moving speed of the antenna 2a and the like may be included in the state quantity vector.
  • the integer value may be determined in advance by using the method of least squares of an integer.
  • Various known methods can be used for the integer least squares method.
  • the LAMBDA Least-squares Ambiguity Decision Association
  • the integer value may be determined by utilizing the fact that the phase difference between the antennas is limited by setting the distance between the antennas to a small value. For example, it is utilized that the phase difference between antennas is limited within the range of ⁇ 0.5 wavelength to +0.5 wavelength by setting the distance between antennas to a value of 1/2 wavelength or less.
  • Determination unit 15a whether or not each of the satellite signals SS 1 ⁇ SS N is in place to determine whether the direct wave signal (i.e., each positioning satellite PS 1 ⁇ PS N is a direct wave received satellite Instead of determining whether or not the antenna 2a is installed in an open sky environment), it may be determined whether or not the antenna 2a is installed. Further, the determination unit 15a may output a signal (that is, a determination result signal) indicating the result of the determination instead of outputting the identification signal indicating each direct wave receiving satellite.
  • a signal that is, a determination result signal
  • the Doppler residual calculator 13 after calculating the Doppler residual f i dop_A_resi according to each of the satellite signals SS 1 ⁇ SS N, calculates the sum of squares RSS dop these Doppler residuals f i dop_A_resi.
  • the Doppler residual calculation unit 13 outputs the calculated sum of squares RSS dop to the determination unit 15a.
  • the sum of squares RSS dop is calculated by the above formula (13).
  • Doppler threshold setting unit 14 the Doppler threshold f i thre (ele, SNR) according to each of the satellite signals SS 1 ⁇ SS N After setting, the sum of the squares of these Doppler threshold f i thre (ele, SNR) Calculate RSS dop_thre.
  • the Doppler threshold setting unit 14 outputs the calculated sum of squares RSS dop_thre to the determination unit 15a.
  • the sum of squares RSS dop_thre is calculated by the above formula (14).
  • the phase difference residual calculating section 17 after calculating the phase difference residual phi i resi according to each of the satellite signals SS 1 ⁇ SS N, calculates the retardation residual phi i resi sum of squares RSS phase To do.
  • the phase difference residual calculation unit 17 outputs the calculated sum of squares RSS phase to the determination unit 15a.
  • the sum of squares RSS phase is calculated by the following equation (26).
  • the phase difference threshold setting section 18 a phase difference threshold phi i thre according to each of the satellite signals SS 1 ⁇ SS N (ele, SNR) After setting, the retardation threshold ⁇ i thre (ele, SNR) Calculate the sum of squares RSS phase_thre of.
  • the phase difference threshold setting unit 18 outputs the calculated sum of squares RSS phase_thre to the determination unit 15a.
  • the sum of squares RSS dop_thre is calculated by the following equation (27).
  • the determination unit 15a includes the sum of squares RSS dop output by the Doppler residual calculation unit 13, the sum of squares RSS dop_thre output by the Doppler threshold setting unit 14, the sum of squares RSS phase output by the phase difference residual calculation unit 17, and the sum of squares RSS phase.
  • the sum of squares RSS phase_thre output by the phase difference threshold setting unit 18 is acquired.
  • the determination unit 15a compares the acquired sum of squares RSS dop with the acquired sum of squares RSS dop_thre, and compares the acquired sum of squares RSS phase with the acquired sum of squares RSS phase_thre .
  • the determination unit 15a determines that the antenna 2a is installed in the open sky environment. In other cases, the determination unit 15a determines that the antenna 2a is installed in a non-open sky environment.
  • the phase difference residual calculation unit 17 may calculate the phase difference residual due to the double phase difference instead of the phase difference residual due to the phase difference between the antennas. Thereby, the initial phase component in the local oscillator (not shown) of each of the satellite signal processing units 11_A and 11_B can be canceled.
  • the antenna attitude estimation section 16 uses the carrier phase observations included in the outputted observation data by the satellite signal processor 11a, the satellite signals SS 1 ⁇ SS double phase difference observations relating to each of the N phi ij AB is calculated.
  • ⁇ ij AB indicates a double phase difference observation value related to each satellite signal SS i with respect to one reference satellite signal SS j.
  • the antenna attitude estimation unit 16 calculates the baseline vector x uAB by the least squares method based on the following equation (28). As a result, the baseline vector estimated value x ( ⁇ ) uAB is calculated.
  • the phase difference residual calculating section 17 using a carrier-phase observations included in the observed data outputted by the satellite signal processor 11a, the double position according to each of the satellite signals SS 1 ⁇ SS N Calculate the phase difference observation value ⁇ ij AB. Then, the phase difference residual calculating section 17, the following equation (29), is calculated double phase difference theory according to each of the satellite signals SS 1 ⁇ SS N value ⁇ a ( ⁇ ) ij AB.
  • the satellite signal determination device 100a can employ various modifications similar to those described in the first embodiment.
  • the antenna 2a may be composed of three or more antennas.
  • the same processing as the above processing may be executed for the baseline vector related to each of the two antennas out of the three or more antennas.
  • the antenna 2a is composed of a plurality of antennas 2_A and 2_B, and the satellite signal receiving device 200a is formed on the plurality of antennas 2_A and 2_B.
  • phase difference threshold setting units 18 for setting a phase difference threshold for comparison are provided, and a plurality of determination units 15a are provided by comparing the Doppler residual with the Doppler threshold and comparing the phase difference residual with the phase difference threshold.
  • each of the number of satellite signals SS 1 ⁇ SS N determines whether the direct wave signal. Therefore, for example, when the moving body 1 is composed of a vehicle, even if the reflected wave by the surface portion parallel to the traveling road surface is received by the antenna 2a, the satellite signals SS 1 to SS N It is possible to accurately determine whether or not each of the signals is a direct wave signal.
  • the antenna 2a is composed of a plurality of antennas 2_A and 2_B, and includes an antenna attitude estimation unit 16 for calculating a baseline vector estimated value related to the plurality of antennas 2_A and 2_B and a plurality of antennas.
  • phase difference residual calculating section 17 for calculating a phase difference residuals, for each of the plurality of satellite signals SS 1 ⁇ SS N, a phase difference threshold setting section 18 for setting a phase difference threshold for comparison to the phase difference residuals the provided, determination unit 15a, the phase difference residuals with comparing the Doppler residuals and Doppler threshold by comparing the phase difference threshold, each of the plurality of satellite signals SS 1 ⁇ SS N in direct wave signal Determine if it exists.
  • the moving body 1 when the moving body 1 is composed of a vehicle, even if the reflected wave by the surface portion parallel to the traveling road surface is received by the antenna 2a, the satellite signals SS 1 to SS N It is possible to accurately determine whether or not each of the signals is a direct wave signal.
  • the satellite signal reception device 200a each of using a plurality of satellite signals SS 1 ⁇ SS N, satellite constellation according to a plurality of positioning satellites PS 1 ⁇ PS N, a plurality of satellite signals SS 1 ⁇ SS N carrier phase observations of the, with Doppler frequency observations, the signal-to-noise ratio observed value according to each of the plurality of satellite signals SS 1 ⁇ SS N, and the satellite signal processing unit 11a for detecting the antenna position of the antenna 2a ,
  • the inter-antenna phase difference observation value is calculated using the carrier phase difference observation value
  • the antenna attitude estimation unit 16 calculates the baseline vector estimation value using the satellite arrangement and the inter-antenna phase difference observation value. This makes it possible to calculate the baseline vector estimate.
  • the phase difference residual calculation unit 17 calculates the theoretical value of the phase difference between antennas using the satellite position vector, the antenna position vector, and the baseline vector estimated value. This makes it possible to calculate the theoretical value of the phase difference between antennas.
  • the satellite signal reception device 200a each of using a plurality of satellite signals SS 1 ⁇ SS N, satellite constellation according to a plurality of positioning satellites PS 1 ⁇ PS N, a plurality of satellite signals SS 1 ⁇ SS N carrier phase observations of the, with Doppler frequency observations, the signal-to-noise ratio observed value according to each of the plurality of satellite signals SS 1 ⁇ SS N, and the satellite signal processing unit 11a for detecting the antenna position of the antenna 2a ,
  • the double phase difference observation value is calculated using the carrier phase difference observation value
  • the antenna attitude estimation unit calculates the baseline vector estimation value using the satellite arrangement and the double phase difference observation value. This makes it possible to calculate the baseline vector estimate.
  • the phase difference residual calculation unit 17 calculates the double phase difference theoretical value using the satellite position vector, the antenna position vector, and the baseline vector estimated value. This makes it possible to calculate the theoretical value of the double phase difference.
  • the antenna attitude estimation unit 16 calculates the baseline vector estimated value by the least squares method or the Kalman filter. This makes it possible to calculate the baseline vector estimate.
  • the antenna attitude estimation unit 16 calculates the baseline vector estimated value by the RANSAC method, the minimum median method, or the M estimation method. That is, the antenna attitude estimation unit 16 calculates the baseline vector estimated value by robust estimation. Thus, Hijika transmitted wave signal to the satellite signal SS 1 ⁇ SS N even when it contains a number, it is possible to accurately calculate the baseline vector estimate.
  • the satellite elevation angles for each of the plurality of positioning satellites PS 1 to PS N are calculated using the satellite arrangement, and the phase difference threshold setting unit 18 is used for a plurality of positions included in the phase difference threshold table.
  • One or more phase difference thresholds corresponding to the satellite elevation angle and the signal-to-noise ratio observed value among the phase difference thresholds are selected, and the phase difference thresholds are set based on the selected one or more phase difference thresholds.
  • the phase difference threshold value can be set to an appropriate value according to the satellite elevation angle and the signal-to-noise ratio observed value.
  • the antenna attitude estimation unit 16 determines the geometrical relationship between the moving direction of the antenna 2a and the installation positions of the plurality of antennas 2_A and 2_B with the velocity vector related to the antenna 2a. It is used as a constraint condition with the baseline vector related to the antennas 2_A and 2_B. This makes it possible to calculate a more accurate baseline vector estimate.
  • FIG. 16 is a block diagram showing a main part of the satellite signal receiving device according to the third embodiment.
  • the satellite signal receiving device according to the third embodiment will be described with reference to FIG.
  • the same blocks as those shown in FIG. 9 are designated by the same reference numerals, and the description thereof will be omitted.
  • the satellite signal determination device 100b has a reception timing correction unit 19.
  • the reception timing correction unit 19 acquires the navigation message and observation data output by the satellite signal processing unit 11a.
  • the reception timing correction unit 19 calculates the clock error in each of the satellite signal processing units 11_A and 11_B by using the acquired navigation message and the acquired observation data.
  • the reception timing correction unit 19 corrects the carrier phase observation value included in the acquired observation data by using the calculated clock error.
  • the reception timing correction unit 19 outputs the corrected carrier wave phase observation value.
  • reception timing correction processing the processes executed by the reception timing correction unit 19 may be collectively referred to as "reception timing correction processing". Details of such reception timing correction processing will be described later with reference to the flowchart of FIG.
  • the phase difference residual calculation unit 17 acquires the corrected carrier wave phase observation value output by the reception timing correction unit 19.
  • the correction output by the reception timing correction unit 19 is replaced with the carrier wave phase observation value included in the observation data output by the satellite signal processing unit 11a. Later carrier phase observations are used.
  • Satellite signal processing unit 11a, antenna direction estimation unit 12, Doppler residual calculation unit 13, Doppler threshold setting unit 14, determination unit 15a, antenna attitude estimation unit 16, phase difference residual calculation unit 17, phase difference threshold setting unit 18, and The reception timing correction unit 19 constitutes a main part of the satellite signal determination device 100b.
  • the satellite signal determination device 100b is provided on the moving body 1, for example.
  • the antenna 2a and the satellite signal determination device 100b constitute a main part of the satellite signal receiving device 200b.
  • the hardware configuration of the main part of the satellite signal determination device 100b is the same as that described with reference to FIG. 2 in the first embodiment. Therefore, illustration and description will be omitted. That is, the satellite signal processing unit 11a, the antenna direction estimation unit 12, the Doppler residual calculation unit 13, the Doppler threshold value setting unit 14, the determination unit 15a, the antenna attitude estimation unit 16, the phase difference residual calculation unit 17, and the phase difference threshold value setting unit.
  • Each function of 18 and the reception timing correction unit 19 may be realized by the processor 21 and the memory 22, or may be realized by the dedicated processing circuit 23.
  • the satellite signal processing unit 11a executes satellite signal processing (step ST1a).
  • the antenna direction estimation unit 12 executes the antenna direction estimation process (step ST2).
  • the Doppler residual calculation unit 13 executes the Doppler residual calculation process (step ST3).
  • the Doppler threshold setting unit 14 executes the Doppler threshold setting process (step ST4).
  • reception timing correction unit 19 executes the reception timing correction process (step ST9).
  • the antenna attitude estimation unit 16 executes the antenna attitude estimation process (step ST6).
  • the phase difference residual calculation unit 17 executes the phase difference residual calculation process (step ST7).
  • the phase difference threshold setting unit 18 executes the phase difference threshold setting process (step ST8).
  • the determination unit 15a executes the determination process (step ST5a).
  • the reception timing correction unit 19 acquires the navigation message and observation data output by the satellite signal processing unit 11a (step ST91).
  • the reception timing correction unit 19 calculates the clock error ⁇ t 1 in the satellite signal processing unit 11_A and calculates the clock error ⁇ t 2 in the satellite signal processing unit 11_B using the acquired navigation message and observation data. (Step ST92).
  • the reception timing correction unit 19 calculates the positioning time by executing the positioning process using the acquired navigation message and observation data.
  • the positioning process executed by the reception timing correction unit 19 is, for example, independent positioning, RTK positioning, or PPP positioning.
  • the reception timing correction unit 19 calculates the clock error ⁇ t 1 by taking the difference between the internal time in the satellite signal processing unit 11_A and the calculated positioning time.
  • the reception timing correction unit 19 calculates the clock error ⁇ t 2 by taking the difference between the internal time in the satellite signal processing unit 11_B and the calculated positioning time.
  • the reception timing correction unit 19 uses the calculated clock errors ⁇ t 1 , ⁇ t 2 and the Doppler frequency observation value included in the acquired observation data to observe the carrier phase phase included in the acquired observation data. Correct the value (step ST93).
  • the carrier phase observations detected by the satellite signal processor 11_A is phi 1
  • Doppler frequency observed values detected by the satellite signal processor 11_A is assumed to be f 1 .
  • the reception timing correction section 19 the following equation (30) to correct the carrier-phase observations phi 1.
  • ⁇ 1_rev indicates the corrected carrier phase observation value for ⁇ 1.
  • the carrier phase observations detected by the satellite signal processor 11_B is phi 2
  • Doppler frequency observed values detected by the satellite signal processor 11_B is assumed to be f 2 .
  • the reception timing correction section 19 corrects the carrier phase observations phi 2 according to the following equation (31).
  • ⁇ 2_rev indicates the carrier phase observation value after correction for ⁇ 2.
  • the reception timing correction unit 19 outputs the corrected carrier wave phase observation values ⁇ 1 and ⁇ 2 (step ST94).
  • the correction of the carrier phase observation values ⁇ 1 and ⁇ 2 by the reception timing correction unit 19 is performed by linear interpolation. Due to such interpolation, even if the time corresponding to the carrier phase observation values ⁇ 1 and ⁇ 2 included in the observation data is deviated, the carrier phase observation values ⁇ 1_rev and ⁇ 2_rev used for calculating the phase difference residual. It is possible to align the time corresponding to. Therefore, the satellite signal processor 11_A, even if the internal clock of 11_B are asynchronous to each other, each of the satellite signals SS 1 ⁇ SS N can be accurately determined whether the direct wave signal ..
  • the interpolation in the reception timing correction process is not limited to the above specific example.
  • the reception timing correction unit 19 may perform quadratic or higher linear interpolation using the carrier phase observation values ⁇ 1 and ⁇ 2 at a plurality of epoch times t.
  • the reception timing correction unit 19 and the carrier phase observation values ⁇ 1 detected at a certain epoch time t 1 by using the carrier phase observations phi 2 detected at time t 2 closest to the epoch time t 1, the clock error is, of course, the interpolation in consideration of the time difference between the epoch time t 1, t 2 It may be something to do.
  • the satellite signal receiving device 200b can employ various modifications similar to those described in the first embodiment. Further, as the satellite signal receiving device 200b, various modifications similar to those described in the second embodiment can be adopted.
  • the satellite signal processing unit 11a is composed of a plurality of satellite signal processing units 11_A and 11_B corresponding to the plurality of antennas 2_A and 2_B.
  • the satellite signal receiving device 200b calculates the clock error in each of the plurality of satellite signal processing units 11_A and 11_B, and corrects the carrier phase observed value by using the clock error and the Doppler frequency observed value. 19 is provided.
  • the satellite signal processor 11_A even if the internal clock of 11_B are asynchronous to each other, each of the satellite signals SS 1 ⁇ SS N can be accurately determined whether the direct wave signal ..
  • FIG. 19 is a block diagram showing a main part of the position measuring device according to the fourth embodiment.
  • the position measuring apparatus according to the fourth embodiment will be described with reference to FIG.
  • the position measuring device 300 includes an antenna 2 and a satellite signal determining device 100. That is, the position measuring device 300 has a satellite signal receiving device 200.
  • the satellite signal receiving device 200 is the same as that described in the first embodiment. Therefore, a detailed description of the satellite signal receiving device 200 will be omitted.
  • the processes executed by the satellite signal determination device 100 may be collectively referred to as "satellite signal determination process".
  • the individual processes included in the satellite signal determination process are the same as those described in the first embodiment. Therefore, detailed description of these processes will be omitted.
  • the position measurement unit 31 acquires the navigation message and observation data output by the satellite signal processing unit 11 of the satellite signal determination device 100.
  • the position measurement unit 31 executes a process of measuring the position of the moving body 1 (hereinafter referred to as “position measurement process”) using the acquired navigation message and observation data.
  • the position measurement unit 31 acquires the identification signal output by the determination unit 15 of the satellite signal determination device 100.
  • the position measurement unit 31 uses the acquired identification signal to use the navigation message and observation data related to the direct wave receiving satellite among the acquired navigation messages and observation data for the position measurement process. .. Further, the position measurement unit 31 excludes the navigation message and the observation data related to the non-direct wave receiving satellite from the acquired navigation message and the observation data from the position measurement process.
  • the direct wave signal of the satellite signals SS 1 ⁇ SS N is adapted to be used in the position measurement processing.
  • the non-direct wave signal of the satellite signals SS 1 ⁇ SS N is adapted to be excluded from the position measurement processing.
  • the satellite signal receiving device 200 and the position measuring unit 31 constitute the main part of the position measuring device 300.
  • the position measuring device 300 has an antenna 2, a processor 41, and a memory 42.
  • the memory 42 stores a program for realizing the functions of the satellite signal determination device 100 and the position measurement unit 31.
  • the processor 41 reads out and executes such a program, the functions of the satellite signal determination device 100 and the position measurement unit 31 are realized.
  • the position measuring device 300 has an antenna 2 and a processing circuit 43.
  • the functions of the satellite signal determination device 100 and the position measurement unit 31 are realized by the dedicated processing circuit 43.
  • the position measuring device 300 has an antenna 2, a processor 41, a memory 42, and a processing circuit 43 (not shown).
  • some of the functions of the satellite signal determination device 100 and the position measurement unit 31 are realized by the processor 41 and the memory 42, and the remaining functions are realized by the dedicated processing circuit 43.
  • the processor 41 is composed of one or a plurality of processors.
  • the individual processors use, for example, CPUs, GPUs, microprocessors, microcontrollers or DSPs.
  • the memory 42 is composed of one or a plurality of non-volatile memories.
  • the memory 42 is composed of one or more non-volatile memories and one or more volatile memories. That is, the memory 42 is composed of one or a plurality of memories.
  • the individual memory uses, for example, a semiconductor memory or a magnetic disk. More specifically, each volatile memory uses, for example, RAM. Further, each non-volatile memory uses, for example, a ROM, a flash memory, an EPROM, an EEPROM, a solid state drive, or a hard disk drive.
  • the processing circuit 43 is composed of one or a plurality of digital circuits. Alternatively, the processing circuit 43 is composed of one or more digital circuits and one or more analog circuits. That is, the processing circuit 43 is composed of one or a plurality of processing circuits.
  • the individual processing circuits use, for example, ASIC, PLD, FPGA, SoC or system LSI.
  • the operation of the position measuring device 300 will be described focusing on the operations of the satellite signal determination device 100 and the position measuring unit 31.
  • the satellite signal determination device 100 executes the satellite signal determination process (step ST101).
  • the position measurement unit 31 executes the position measurement process (step ST102).
  • the position measuring device 300 may have a satellite signal receiving device 200a instead of the satellite signal receiving device 200.
  • the satellite signal receiving device 200a is the same as that described in the second embodiment. Therefore, detailed description of the satellite signal receiving device 200a will be omitted.
  • the position measuring device 300 may have a satellite signal receiving device 200b instead of the satellite signal receiving device 200.
  • the satellite signal receiving device 200b is the same as that described in the third embodiment. Therefore, a detailed description of the satellite signal receiving device 200b will be omitted.
  • the determination unit 15 may determine whether or not the antenna 2 is installed in the open sky environment. Further, as described in the second embodiment, the determination unit 15a may determine whether or not the antenna 2a is installed in the open sky environment.
  • the position measurement unit 31 acquires the determination result signal output by the determination unit 15 (or the determination unit 15a).
  • the position measurement unit 31 executes the position measurement process when the antenna 2 (or the antenna 2a) is installed in the open sky environment by using the acquired determination result signal.
  • the position measurement unit 31 cancels the execution of the position measurement process.
  • the direct wave signal can be used for the position measurement process, and the non-direct wave signal can be excluded from the position measurement process.
  • satellite signal receiving device 200 in the position measuring device 300 various modifications similar to those described in the first embodiment can be adopted. Further, as the satellite signal receiving device 200a in the position measuring device 300, various modifications similar to those described in the first and second embodiments can be adopted. Further, as the satellite signal receiving device 200b in the position measuring device 300, various modifications similar to those described in the first to third embodiments can be adopted.
  • the position measuring device 300 is a plurality of position measuring devices 300 based on the satellite signal receiving device 200, the satellite signal receiving device 200a or the satellite signal receiving device 200b, and the determination result by the determination unit 15 or the determination unit 15a.
  • the position of the moving body 1 can be measured with high accuracy.
  • the satellite signal receiving device and the position measuring device of the present invention can be used, for example, for measuring the position of a vehicle, a ship, an aircraft, or a mobile information terminal.

Abstract

衛星信号受信装置(200)は、複数個の測位衛星(PS~PS)によりそれぞれ送信された複数個の衛星信号(SS~SS)を受信するアンテナ(2)と、アンテナ(2)に係るアンテナ速度ベクトル推定値を算出するアンテナ方向推定部(12)と、複数個の衛星信号(SS~SS)の各々について、アンテナ速度ベクトル推定値を用いてドップラ周波数理論値を算出して、ドップラ周波数理論値とドップラ周波数観測値との差分を示すドップラ残差を算出するドップラ残差算出部(13)と、複数個の衛星信号(SS~SS)の各々について、ドップラ残差に対する比較用のドップラ閾値を設定するドップラ閾値設定部(14)と、ドップラ残差をドップラ閾値と比較することにより、複数個の衛星信号(SS~SS)の各々が直達波信号であるか否かを判定する判定部(15)と、を備える。

Description

衛星信号受信装置及び位置測定装置
 本発明は、衛星信号受信装置及び位置測定装置に関する。
 従来、複数個の人工衛星(以下「測位衛星」という。)を用いて車両等の移動体の位置を測定するシステムが開発されている。すなわち、GNSS(Global Navigation Satellite System)が開発されている。また、GNSSにおいて、個々の測位衛星により送信された信号(以下「衛星信号」という。)を受信する装置(以下「衛星信号受信装置」という。)が開発されている。
 衛星信号受信装置により受信される衛星信号は、いわゆる「直達波」に対応する信号(以下「直達波信号」という。)を含むものである。また、衛星信号受信装置により受信される衛星信号は、建物等の物体による反射波又は回折波など(以下「非直達波」と総称する。)に対応する信号(以下「非直達波信号」という。)を含むものである。ここで、移動体の位置の測定に非直達波信号が用いられることにより、測定誤差が発生する。かかる測定誤差の発生を抑制する観点から、非直達波信号を移動体の位置の測定から除外するのが好適である。
 そこで、個々の衛星信号が直達波信号であるか否かを判定することが求められる。換言すれば、個々の衛星信号が非直達波信号であるか否かを判定することが求められる。特許文献1には、個々の衛星信号が非直達波信号であるか否かを判定する技術が開示されている(例えば、特許文献1の段落[0077]~段落[0113]及び図6~図9参照。)。
 すなわち、複数個のアンテナ(第1のアンテナ及び第2のアンテナを含む。)が車両に設けられている。複数個の測位衛星が複数個の衛星信号をそれぞれ送信したとき、当該送信された複数個の衛星信号が複数個のアンテナにより受信される。当該受信された複数個の衛星信号を用いて、複数個の測位衛星の各々の位置が取得されるとともに、車両の位置が算出される。また、第1のアンテナにより受信された衛星信号と第2のアンテナにより受信された衛星信号との位相差が取得される。また、当該受信された複数個の衛星信号の各々に係るドップラ周波数が取得される。
 上記取得された位置及び上記算出された位置に基づき、複数個の測位衛星の各々について、車両に対する電波の絶対的な到来方向が算出される。また、上記取得された位相差に基づき、複数個の測位衛星の各々について、車両に対する電波の相対的な到来方向が推定される。また、上記取得されたドップラ周波数に基づき、車両の絶対的な走行方向が推定される。
 上記推定された絶対的な走行方向及び上記推定された相対的な到来方向に基づき、複数個の測位衛星の各々について、車両に対する電波の絶対的な到来方向が推定される。複数個の測位衛星の各々について、当該推定された絶対的な到来方向と上記算出された絶対的な到来方向とが比較される。これにより、上記受信された複数個の衛星信号の各々が非直達波信号であるか否かが判定される。
特開2010-256301号公報
 特許文献1記載の技術において、車両に対する電波の相対的な到来方向は、車両における複数個のアンテナの設置方向(以下「アンテナ設置方向」という。)を基準とするものである(特許文献1の段落[0047]等参照。)。ここで、特許文献1記載の技術においては、車両の走行方向がアンテナ設置方向と一致していなければ、上記判定をすることができない問題があった。換言すれば、車両が停止しているとき、及びアンテナ設置方向と異なる方向に車両が走行しているとき、上記判定をすることができない問題があった。
 例えば、車両が曲線状の経路を走行しているときは、車両の走行方向がアンテナ設置方向と不一致である蓋然性が高い。このような場合、上記判定をすることができない問題があった。
 本発明は、上記のような課題を解決するためになされたものであり、移動体が移動中であるか否かにかかわらず、かつ、移動体の移動方向にかかわらず、個々の衛星信号が直達波信号であるか否かを判定することを目的とする。
 本発明の衛星信号受信装置は、複数個の測位衛星によりそれぞれ送信された複数個の衛星信号を受信するアンテナと、アンテナに係るアンテナ速度ベクトル推定値を算出するアンテナ方向推定部と、複数個の衛星信号の各々について、アンテナ速度ベクトル推定値を用いてドップラ周波数理論値を算出して、ドップラ周波数理論値とドップラ周波数観測値との差分を示すドップラ残差を算出するドップラ残差算出部と、複数個の衛星信号の各々について、ドップラ残差に対する比較用のドップラ閾値を設定するドップラ閾値設定部と、ドップラ残差をドップラ閾値と比較することにより、複数個の衛星信号の各々が直達波信号であるか否かを判定する判定部と、を備えるものである。
 本発明によれば、上記のように構成したので、移動体が移動中であるか否かにかかわらず、かつ、移動体の移動方向にかかわらず、個々の衛星信号が直達波信号であるか否かを判定することができる。
実施の形態1に係る衛星信号受信装置の要部を示すブロック図である。 実施の形態1に係る衛星信号受信装置における衛星信号判定装置のハードウェア構成を示すブロック図である。 実施の形態1に係る衛星信号受信装置における衛星信号判定装置の他のハードウェア構成を示すブロック図である。 実施の形態1に係る衛星信号受信装置における衛星信号判定装置の動作を示すフローチャートである。 実施の形態1に係る衛星信号受信装置におけるアンテナ方向推定部の詳細な動作を示すフローチャートである。 衛星位置ベクトル、衛星速度ベクトル、アンテナ位置ベクトル、アンテナ速度ベクトル及び視線ベクトルの関係を示す説明図である。 実施の形態1に係る衛星信号受信装置におけるドップラ残差算出部の詳細な動作を示すフローチャートである。 実施の形態1に係る衛星信号受信装置におけるドップラ閾値設定部の詳細な動作を示すフローチャートである。 実施の形態1に係る衛星信号受信装置における判定部の詳細な動作を示すフローチャートである。 実施の形態2に係る衛星信号受信装置の要部を示すブロック図である。 実施の形態2に係る衛星信号受信装置における衛星信号判定装置の動作を示すフローチャートである。 実施の形態2に係る衛星信号受信装置におけるアンテナ姿勢推定部の詳細な動作を示すフローチャートである。 アンテナ間位相差、アンテナ間距離、基線ベクトル及び信号到来角度の対応関係を示す説明図である。 実施の形態2に係る衛星信号受信装置における位相差残差算出部の詳細な動作を示すフローチャートである。 実施の形態2に係る衛星信号受信装置における位相差閾値設定部の詳細な動作を示すフローチャートである。 実施の形態2に係る衛星信号受信装置における判定部の詳細な動作を示すフローチャートである。 実施の形態3に係る衛星信号受信装置の要部を示すブロック図である。 実施の形態3に係る衛星信号受信装置における衛星信号判定装置の動作を示すフローチャートである。 実施の形態3に係る衛星信号受信装置における受信タイミング補正部の詳細な動作を示すフローチャートである。 実施の形態4に係る位置測定装置の要部を示すブロック図である。 実施の形態4に係る位置測定装置のハードウェア構成を示すブロック図である。 実施の形態4に係る位置測定装置の他のハードウェア構成を示すブロック図である。 実施の形態4に係る位置測定装置における衛星信号判定装置及び位置測定部の動作を示すフローチャートである。 実施の形態4に係る他の位置測定装置の要部を示すブロック図である。 実施の形態4に係る他の位置測定装置の要部を示すブロック図である。
 以下、この発明をより詳細に説明するために、この発明を実施するための形態について、添付の図面に従って説明する。
 以下、1個のアンテナ又は複数個のアンテナが移動体に設けられているとき、これらのアンテナの位置を「アンテナ位置」という。また、このとき、これらのアンテナに係る位置ベクトルを「アンテナ位置ベクトル」という。また、このとき、これらのアンテナに係る速度ベクトルを「アンテナ速度ベクトル」という。また、このとき、アンテナ速度ベクトルの推定値を「アンテナ速度ベクトル推定値」という。
 以下、複数個の測位衛星の配置を「衛星配置」という。すなわち、衛星配置は、複数個の測位衛星の各々の位置を示すものである。また、複数個の測位衛星の各々に係る位置ベクトルを「衛星位置ベクトル」という。また、複数個の測位衛星の各々に係る速度ベクトルを「衛星速度ベクトル」という。
 以下、複数個の測位衛星によりそれぞれ送信された複数個の衛星信号が1個のアンテナ又は複数個のアンテナにより受信されたとき、複数個の衛星信号の各々に係る搬送波位相の観測値を「搬送波位相観測値」という。なお、搬送波位相の単位は、波数である。また、このとき、複数個の衛星信号の各々に係る信号対雑音比の観測値を「信号対雑音比観測値」という。また、このとき、複数個の衛星信号の各々に係るドップラ周波数の観測値を「ドップラ周波数観測値」という。また、このとき、複数個の衛星信号の各々に係るドップラ周波数の変移量を「ドップラ変移量」という。また、このとき、複数個の衛星信号の各々に係るドップラ周波数の理論値を「ドップラ周波数理論値」という。また、このとき、複数個の衛星信号の各々について、ドップラ周波数観測値とドップラ周波数理論値との差分を「ドップラ残差」という。また、このとき、複数個の衛星信号の各々について、ドップラ残差に対する比較用の閾値を「ドップラ閾値」という。
 以下、複数個の測位衛星によりそれぞれ送信された複数個の衛星信号が複数個のアンテナにより受信されたとき、複数個の衛星信号の各々について、かつ、複数個のアンテナのうちの各2個のアンテナについて、一方のアンテナにより受信された衛星信号の搬送波位相と他方のアンテナにより受信された衛星信号の搬送波位相との差分を「アンテナ間位相差」という。また、このとき、複数個の衛星信号の各々に係るアンテナ間位相差の観測値を「アンテナ間位相差観測値」という。また、このとき、複数個の衛星信号の各々に係るアンテナ間位相差の理論値を「アンテナ間位相差理論値」という。また、このとき、複数個の衛星信号の各々に係るアンテナ間位相差と複数個の衛星信号のうちの基準となる1個の衛星信号に係るアンテナ間位相差との差分を「二重位相差」という。また、このとき、二重位相差の観測値を「二重位相差観測値」という。また、このとき、二重位相差の理論値を「二重位相差理論値」という。また、このとき、複数個の衛星信号の各々について、アンテナ間位相差観測値とアンテナ間位相差理論値との差分又は二重位相差観測値と二重位相差理論値との差分を「位相差残差」という。また、このとき、複数個の衛星信号の各々について、位相差残差に対する比較用の閾値を「位相差閾値」という。
 以下、複数個の測位衛星の各々に対する1個のアンテナ又は複数個のアンテナによる視線方向を示すベクトルを「視線ベクトル」という。また、視線ベクトルのうちの単位ベクトルを「単位視線ベクトル」という。また、複数個のアンテナのうちの各2個のアンテナについて、一方のアンテナに係るアンテナ位置ベクトルと他方のアンテナに係るアンテナ位置ベクトルとを結ぶベクトルを「基線ベクトル」という。また、基線ベクトルのうちの単位ベクトルを「単位基線ベクトル」という。また、基線ベクトルの推定値を「基線ベクトル推定値」という。
 以下、複数個の測位衛星の各々について、水平面に対する視線ベクトルの角度を「衛星仰角」という。また、複数個の測位衛星の各々に係る識別用の情報を「識別情報」という。識別情報は、例えば、対応する測位衛星の種別を示す情報、及び対応する測位衛星のPRN(Pseudo Random Noise)番号を示す情報を含むものである。
 以下、複数個の測位衛星によりそれぞれ送信された複数個の衛星信号が1個のアンテナ又は複数個のアンテナにより受信された場合において、複数個の衛星信号のうちの1個以上の衛星信号が直達波信号であるとき、当該1個以上の衛星信号に対応する1個以上の測位衛星を「直達波受信衛星」という。また、この場合において、複数個の衛星信号のうちの1個以上の衛星信号が非直達波信号であるとき、当該1個以上の衛星信号に対応する1個以上の測位衛星を「非直達波受信衛星」という。
 以下、複数個の測位衛星によりそれぞれ送信された複数個の衛星信号が1個のアンテナ又は複数個のアンテナにより受信されたとき、複数個の衛星信号のうちの直達波信号の候補となる1個以上の衛星信号を「直達波候補信号」という。また、このとき、複数個の測位衛星のうちの直達波受信衛星の候補となる1個以上の測位衛星を「直達波受信候補衛星」という。
 以下、衛星仰角及び信号対雑音比による組合せを「衛星仰角-信号対雑音比対」という。また、複数個のドップラ閾値と複数個の衛星仰角-信号対雑音比対との対応関係を示すテーブルを「ドップラ閾値テーブル」という。また、複数個の位相差閾値と複数個の衛星仰角-信号対雑音比対との対応関係を示すテーブルを「位相差閾値テーブル」という。
 以下、文字「x」に対する上方に記号「・」を付してなる符号を「x(・)」と記載することがある。また、文字「x」に対する上方に記号「^」を付してなる符号を「x(^)」と記載することがある。また、文字「x」に対する上方に記号「・」及び記号「^」を付してなる符号を「x(・,^)」と記載することがある。また、文字「δ」に対する上方に記号「・」を付してなる符号を「δ(・)」と記載することがある。また、文字「f」に対する上方に記号「^」を付してなる符号を「f(^)」と記載することがある。また、文字「φ」に対する上方に記号「^」を付してな符号を「φ(^)」と記載することがある。
 以下、N個の整数値(1~N)のうちの個々の整数値を示す変数を「i」と記載することがある。また、N個の整数値(1~N)のうちの基準となる1個の整数値を示す変数を「j」と記載することがある。ここで、Nは、2以上の任意の整数である。
実施の形態1.
 図1は、実施の形態1に係る衛星信号受信装置の要部を示すブロック図である。図1を参照して、実施の形態1に係る衛星信号受信装置について説明する。
 図中、1は移動体である。移動体1は、例えば、車両、船舶、航空機又は携帯情報端末により構成されている。移動体1は、アンテナ2を有している。アンテナ2は、測位衛星PS~PSが衛星信号SS~SSをそれぞれ送信したとき、当該送信されたN個の衛星信号SS~SSを受信するものである。アンテナ2は、当該受信された衛星信号SS~SSを衛星信号処理部11に出力するものである。ここで、測位衛星PS~PSとアンテナ2間における衛星信号SS~SSは、電波により構成されている。これに対して、アンテナ2と衛星信号処理部11間における衛星信号SS~SSは、高周波信号により構成されている。すなわち、アンテナ2は、電波を高周波信号に変換するものである。
 個々の測位衛星PS~PSは、GNSS衛星により構成されている。具体的には、例えば、個々の測位衛星PS~PSは、GPS(Global Positioning System)衛星、GLONASS(Global Navigation Satellite System)衛星、BeiDou衛星、Galileo衛星又はQZSS(Quasi-Zenith Satellite System)衛星により構成されている。
 アンテナ2により受信される衛星信号SS~SSの個数(すなわち、これらの衛星信号SS~SSを送信した測位衛星PS~PSの個数)は、GNSSに含まれる測位衛星の総数、GNSSに含まれる個々の測位衛星の位置、及び地球における移動体1の位置などに応じて異なるものである。すなわち、Nの値は、これらの要素に応じて異なるものである。
 衛星信号処理部11は、アンテナ2により出力された衛星信号SS~SSを取得するものである。衛星信号処理部11は、当該取得された衛星信号SS~SSに対して、通常のGNSS受信機により実行される処理(衛星補足処理、衛星追尾処理及び復調処理を含む。)と同様の処理を実行するものである。これにより、衛星配置、搬送波位相観測値、ドップラ周波数観測値及び信号対雑音比観測値などが検出される。衛星信号処理部11は、当該検出された衛星配置を含むデータ(以下「航法メッセージ」という。)を出力するものである。また、衛星信号処理部11は、当該検出された搬送波位相観測値、ドップラ周波数観測値及び信号対雑音比観測値を含むデータ(以下「観測データ」という。)を出力するものである。
 また、衛星信号処理部11は、航法メッセージ及び観測データを用いて、通常のGNSS受信機により実行される測位処理と同様の測位処理を実行するものである。これにより、アンテナ位置が検出される。衛星信号処理部11により実行される測位処理は、例えば、単独測位、RTK(Real Time Kinematic)測位又はPPP(Precise Point Positioning)測位によるものである。衛星信号処理部11は、当該検出されたアンテナ位置を含むデータ(以下「アンテナ位置データ」という。)を出力するものである。
 以下、衛星信号処理部11により実行される処理を総称して「衛星信号処理」ということがある。
 アンテナ方向推定部12は、衛星信号処理部11により出力された航法メッセージ、観測データ及びアンテナ位置データを取得するものである。アンテナ方向推定部12は、当該取得された航法メッセージ、観測データ及びアンテナ位置データを用いて、アンテナ速度ベクトル推定値を算出するものである。アンテナ方向推定部12は、当該算出されたアンテナ速度ベクトル推定値を出力するものである。
 以下、アンテナ方向推定部12により実行される処理を総称して「アンテナ方向推定処理」ということがある。かかるアンテナ方向推定処理の詳細については、図4のフローチャートを参照して後述する。
 ドップラ残差算出部13は、衛星信号処理部11により出力された航法メッセージ、観測データ及びアンテナ位置データを取得するとともに、アンテナ方向推定部12により出力されたアンテナ速度ベクトル推定値を取得するものである。ドップラ残差算出部13は、当該取得された航法メッセージ、観測データ、アンテナ位置データ及びアンテナ速度ベクトル推定値を用いて、衛星信号SS~SSの各々に係るドップラ残差を算出するものである。ドップラ残差算出部13は、当該算出されたドップラ残差を出力するものである。
 以下、ドップラ残差算出部13により実行される処理を総称して「ドップラ残差算出処理」ということがある。かかるドップラ残差算出処理の詳細については、図6のフローチャートを参照して後述する。
 ドップラ閾値設定部14は、衛星信号処理部11により出力された航法メッセージ、観測データ及びアンテナ位置データを取得するものである。ドップラ閾値設定部14は、当該取得された航法メッセージ、観測データ及びアンテナ位置データを用いて、衛星信号SS~SSの各々に係るドップラ閾値を設定するものである。ドップラ閾値設定部14は、当該設定されたドップラ閾値を出力するものである。
 以下、ドップラ閾値設定部14により実行される処理を総称して「ドップラ閾値設定処理」ということがある。かかるドップラ閾値設定処理の詳細については、図7のフローチャートを参照して後述する。
 判定部15は、ドップラ残差算出部13により出力されたドップラ残差を取得するとともに、ドップラ閾値設定部14により出力されたドップラ閾値を取得するものである。判定部15は、当該取得されたドップラ残差及びドップラ残差を用いて、衛星信号SS~SSの各々が直達波信号であるか否かを判定するものである。すなわち、判定部15は、測位衛星PS~PSの各々が直達波受信衛星であるか否かを判定するものである。判定部15は、当該判定の結果に基づき、直達波受信衛星を示す識別情報を出力するものである。
 以下、判定部15により実行される処理を総称して「判定処理」ということがある。かかる判定処理の詳細については、図8のフローチャートを参照して後述する。
 衛星信号処理部11、アンテナ方向推定部12、ドップラ残差算出部13、ドップラ閾値設定部14及び判定部15により、衛星信号判定装置100の要部が構成されている。衛星信号判定装置100は、例えば、移動体1に設けられている。アンテナ2及び衛星信号判定装置100により、衛星信号受信装置200の要部が構成されている。
 次に、図2を参照して、衛星信号判定装置100の要部のハードウェア構成について説明する。
 図2Aに示す如く、衛星信号判定装置100は、プロセッサ21及びメモリ22を有している。メモリ22には、衛星信号処理部11、アンテナ方向推定部12、ドップラ残差算出部13、ドップラ閾値設定部14及び判定部15の機能を実現するためのプログラムが記憶されている。かかるプログラムをプロセッサ21が読み出して実行することにより、衛星信号処理部11、アンテナ方向推定部12、ドップラ残差算出部13、ドップラ閾値設定部14及び判定部15の機能が実現される。
 または、図2Bに示す如く、衛星信号判定装置100は、処理回路23を有している。この場合、衛星信号処理部11、アンテナ方向推定部12、ドップラ残差算出部13、ドップラ閾値設定部14及び判定部15の機能は、専用の処理回路23により実現される。
 または、衛星信号判定装置100は、プロセッサ21、メモリ22及び処理回路23を有している(不図示)。この場合、衛星信号処理部11、アンテナ方向推定部12、ドップラ残差算出部13、ドップラ閾値設定部14及び判定部15の機能のうちの一部の機能がプロセッサ21及びメモリ22により実現されるとともに、残余の機能が専用の処理回路23により実現される。
 プロセッサ21は、1個又は複数個のプロセッサにより構成されている。個々のプロセッサは、例えば、CPU(Central Processing Unit)、GPU(Graphics Processing Unit)、マイクロプロセッサ、マイクロコントローラ又はDSP(Digital Signal Processor)を用いたものである。
 メモリ22は、1個又は複数個の不揮発性メモリにより構成されている。または、メモリ22は、1個又は複数個の不揮発性メモリ及び1個又は複数個の揮発性メモリにより構成されている。すなわち、メモリ22は、1個又は複数個のメモリにより構成されている。個々のメモリは、例えば、半導体メモリ又は磁気ディスクを用いたものである。より具体的には、個々の揮発性メモリは、例えば、RAM(Random Access Memory)を用いたものである。また、個々の不揮発性メモリは、例えば、ROM(Read Only Memory)、フラッシュメモリ、EPROM(Erasable Programmable Read Only Memory)、EEPROM(Ectrically Erasable Programmable Read Only Memory)、ソリッドステートドライブ又はハードディスクドライブを用いたものである。
 処理回路23は、1個又は複数個のデジタル回路により構成されている。または、処理回路23は、1個又は複数個のデジタル回路及び1個又は複数個のアナログ回路により構成されている。すなわち、処理回路23は、1個又は複数個の処理回路により構成されている。個々の処理回路は、例えば、ASIC(Application Specific Integrated Circuit)、PLD(Programmable Logic Device)、FPGA(Field Programmable Gate Array)、SoC(System on a Chip)又はシステムLSI(Large Scale Integration)を用いたものである。
 次に、図3のフローチャートを参照して、衛星信号受信装置200の動作について、衛星信号判定装置100の動作を中心に説明する。
 まず、衛星信号処理部11が衛星信号処理を実行する(ステップST1)。次いで、アンテナ方向推定部12がアンテナ方向推定処理を実行する(ステップST2)。次いで、ドップラ残差算出部13がドップラ残差算出処理を実行する(ステップST3)。次いで、ドップラ閾値設定部14がドップラ閾値設定処理を実行する(ステップST4)。次いで、判定部15が判定処理を実行する(ステップST5)。
 次に、図4のフローチャートを参照して、アンテナ方向推定部12によるアンテナ方向推定処理の詳細について説明する。
 まず、アンテナ方向推定部12は、衛星信号処理部11により出力された航法メッセージ、観測データ及びアンテナ位置データを取得する(ステップST11)。
 ここで、当該取得された航法メッセージに含まれる衛星配置に基づき、衛星位置ベクトルx及び衛星速度ベクトルx(・)が検出される。衛星速度ベクトルx(・)は、例えば、衛星配置に対する時間微分により検出される。また、当該取得された観測データに含まれるドップラ周波数観測値f dop_A_obsに基づき、ドップラ変移量Δf dop_Aが検出される。また、当該取得されたアンテナ位置データに含まれるアンテナ位置に基づき、アンテナ位置ベクトルxが検出される。
 図5は、衛星位置ベクトルx、衛星速度ベクトルx(・)、アンテナ位置ベクトルx、アンテナ速度ベクトルx(・)及び視線ベクトルの関係を示している。このとき、ドップラ変移量Δf dop_Aについて、以下の式(1)が成立する。ここで、fcarは、衛星信号SS~SSの各々に係る搬送波の中心周波数を示している。また、cは、光速を示している。
Figure JPOXMLDOC01-appb-I000001
 変数iについて(i=1~N)、上記式(1)を行列形式に変形することにより、以下の式(2)が得られる。
Figure JPOXMLDOC01-appb-I000002
 なお、上記式(2)におけるベクトル値(式中u)は、以下の式(3)により定義されるものである。また、上記式(2)におけるスカラ値(式中S)は、以下の式(4)により定義されるものである。

Figure JPOXMLDOC01-appb-I000003

Figure JPOXMLDOC01-appb-I000004
 次いで、アンテナ方向推定部12は、上記検出された衛星位置ベクトルx、衛星速度ベクトルx(・)、ドップラ変移量Δf dop_A及びアンテナ位置ベクトルxを用いて、上記式(2)に基づく最小二乗法によりアンテナ速度ベクトルx(・)を算出する。これにより、アンテナ速度ベクトル推定値x(・,^)が算出される(ステップST12)。
 次いで、アンテナ方向推定部12は、当該算出されたアンテナ速度ベクトル推定値x(・,^)を出力する(ステップST13)。
 次に、図6のフローチャートを参照して、ドップラ残差算出部13によるドップラ残差算出処理の詳細について説明する。
 まず、ドップラ残差算出部13は、衛星信号処理部11により出力された航法メッセージ、観測データ及びアンテナ位置データを取得する。また、ドップラ残差算出部13は、アンテナ方向推定部12により出力されたアンテナ速度ベクトル推定値x(・,^)を取得する(ステップST21)。
 ここで、当該取得された航法メッセージに含まれる衛星配置に基づき、衛星位置ベクトルx及び衛星速度ベクトルx(・)が検出される。衛星速度ベクトルx(・)は、例えば、衛星配置に対する時間微分により検出される。また、当該取得されたアンテナ位置データに含まれるアンテナ位置に基づき、アンテナ位置ベクトルxが検出される。
 次いで、ドップラ残差算出部13は、当該取得されたアンテナ速度ベクトル推定値x(・,^)並びに当該検出された衛星位置ベクトルx、衛星速度ベクトルx(・)及びアンテナ位置ベクトルxを用いて、衛星信号SS~SSの各々に係るドップラ周波数理論値f(^) dop_Aを算出する(ステップST22)。このとき、ドップラ残差算出部13は、以下の式(5)によりドップラ周波数理論値f(^) dop_Aを算出する。
Figure JPOXMLDOC01-appb-I000005
 次いで、ドップラ残差算出部13は、当該算出されたドップラ周波数理論値f(^) dop_A及び上記取得された観測データに含まれるドップラ周波数観測値f dop_A_obsを用いて、衛星信号SS~SSの各々に係るドップラ残差f dop_A_resiを算出する(ステップST23)。このとき、ドップラ残差算出部13は、以下の式(6)によりドップラ残差f dop_A_resiを算出する。

Figure JPOXMLDOC01-appb-I000006
 次いで、ドップラ残差算出部13は、当該算出されたドップラ残差f dop_A_resiを出力する(ステップST24)。
 次に、図7のフローチャートを参照して、ドップラ閾値設定部14によるドップラ閾値設定処理の詳細について説明する。
 まず、ドップラ閾値設定部14は、衛星信号処理部11により出力された航法メッセージ、観測データ及びアンテナ位置データを取得する(ステップST31)。
 ここで、当該取得された航法メッセージに含まれる衛星位置に基づき、衛星位置ベクトルxが検出される。また、当該取得されたアンテナ位置データに基づき、アンテナ位置ベクトルxが検出される。
 次いで、ドップラ閾値設定部14は、当該検出された衛星位置ベクトルx及びアンテナ位置ベクトルxを用いて、測位衛星PS~PSの各々に係る衛星仰角eleを算出する(ステップST32)。
 次いで、ドップラ閾値設定部14は、当該算出された衛星仰角ele及び上記取得された観測データに含まれる信号対雑音比観測値SNRを用いて、衛星信号SS~SSの各々に係るドップラ閾値f thre(ele,SNR)を設定する(ステップST33)。
 ここで、ドップラ閾値設定部14は、ドップラ閾値テーブルを有している。ドップラ閾値設定部14は、測位衛星PS~PSの各々について(すなわち衛星信号SS~SSの各々について)、ドップラ閾値テーブルに含まれる複数個のドップラ閾値のうちの衛星仰角ele及び信号対雑音比観測値SNRによる衛星仰角-信号対雑音比対に対応する1個のドップラ閾値を選択する。ドップラ閾値設定部14は、当該選択された1個のドップラ閾値をドップラ閾値f thre(ele,SNR)に用いる。
 次いで、ドップラ閾値設定部14は、当該設定されたドップラ閾値f thre(ele,SNR)を出力する(ステップST34)。
 なお、ドップラ閾値テーブルにおける複数個のドップラ閾値が離散的に定義されている場合、衛星仰角ele及び信号対雑音比観測値SNRによる衛星仰角-信号対雑音比対に対応する1個のドップラ閾値を選択することが困難である場合がある。この場合、ドップラ閾値設定部14は、かかる衛星仰角-信号対雑音比対に対応する2個以上のドップラ閾値を選択するものであっても良い。そして、ドップラ閾値設定部14は、当該選択された2個以上のドップラ閾値に対する補間処理を実行することにより、ドップラ閾値f thre(ele,SNR)を設定するものであっても良い。
 次に、図8のフローチャートを参照して、判定部15による判定処理の詳細について説明する。
 まず、判定部15は、ドップラ残差算出部13により出力されたドップラ残差f dop_A_resiを取得する。また、判定部15は、ドップラ閾値設定部14により出力されたドップラ閾値f thre(ele,SNR)を取得する(ステップST41)。
 次いで、判定部15は、衛星信号SS~SSの各々について、当該取得されたドップラ残差f dop_A_resiを当該取得されたドップラ閾値f thre(ele,SNR)と比較する(ステップST42)。これにより、衛星信号SS~SSの各々が直達波信号であるか否かが判定される。
 すなわち、ドップラ残差f dop_A_resiがドップラ閾値f thre(ele,SNR)以下である場合、判定部15は、対応する衛星信号SSが直達波信号であると判定する。換言すれば、この場合、判定部15は、対応する測位衛星PSが直達波受信衛星であるとする。他方、ドップラ残差f dop_A_resiがドップラ閾値f thre(ele,SNR)よりも大きい場合、判定部15は、対応する衛星信号SSが非直達波信号であると判定する。換言すれば、この場合、判定部15は、対応する測位衛星PSが非直達波受信衛星であると判定する。
 次いで、判定部15は、ステップST42における判定結果に基づき、個々の直達波受信衛星を示す識別情報を出力する(ステップST43)。
 このように、衛星信号判定装置100は、ドップラ残差f dop_A_resiをドップラ閾値f thre(ele,SNR)と比較することにより、衛星信号SS~SSの各々が直達波信号であるか否かを判定する。これにより、移動体1が移動中であるか否かにかかわらず、当該判定をすることができる。また、移動体1の移動方向にかかわらず、当該判定をすることができる。この結果、例えば、移動体1が曲線移動をしているときであっても、当該判定をすることができる。
 次に、ドップラ閾値テーブルの生成方法について説明する。ドップラ閾値テーブルは、例えば、以下のようにして生成されるものである。
 いま、アンテナ2と同様の1個のアンテナが設置されており、かつ、当該1個のアンテナに対する上空に障害物が存在しないものとする。すなわち、当該1個のアンテナは、いわゆる「オープンスカイ環境」に設置されている。かかる状態にて、測位衛星PS~PSと同様の複数個の測位衛星が衛星信号SS~SSと同様の複数個の衛星信号をそれぞれ送信する。当該1個のアンテナは、当該複数個の衛星信号を受信する。
 次いで、当該複数個の衛星信号に対して、衛星信号処理部11による衛星信号処理と同様の処理、アンテナ方向推定部12によるアンテナ方向推定処理と同様の処理、及びドップラ残差算出部13によるドップラ残差算出処理と同様の処理が実行される。
 当該複数個の測位衛星の各々について(すなわち当該複数個の衛星信号の各々について)、衛星仰角及び信号対雑音比が異なる条件下にて、これらの手順が繰り返し実行される。これにより、衛星仰角-信号対雑音比対に対するドップラ残差の確率分布が得られる。そして、この確率分布に基づき、衛星仰角-信号対雑音比対毎のドップラ閾値が設定される。このようにして、ドップラ閾値テーブルが生成される。
 次に、衛星信号判定装置100の変形例について説明する。
 衛星信号処理部11の内部クロックの精度が低いことにより、衛星信号処理部11の内部クロックが示す時刻(以下「内部時刻」という。)と衛星信号SS~SSに対する測位処理が実行されることにより算出される時刻(以下「測位時刻」という。)との差分(以下「クロック誤差」という。)が大きいことがある。この場合、ドップラ周波数観測値f dop_A_obsに基づき、以下のようなドップラ変移量Δf dop_A_obsが検出されることがある。すなわち、ドップラ変移量Δf dop_A_obsは、ドップラ変移量Δf dop_Aに対して時間微分量δ(・)(t)が重畳してなるものである。このため、ドップラ変移量Δf dop_A_obsは、以下の式(7)により表される。
Figure JPOXMLDOC01-appb-I000007
 変数iについて(i=1~N)、上記式(7)を行列形式に変形することにより、以下の式(8)が得られる。
Figure JPOXMLDOC01-appb-I000008
 この場合、アンテナ方向推定部12は、時間微分量δ(・)(t)が未知数であるとみなして、上記式(8)に基づく最小二乗法によりアンテナ速度ベクトルx(・)を算出する。これにより、アンテナ速度ベクトル推定値x(・,^)が算出される。すなわち、衛星信号処理部11の内部クロックの精度が低い場合であっても、アンテナ速度ベクトル推定値x(・,^)を算出することができる。
 また、この場合、ドップラ残差算出部13は、以下の式(9)により、衛星信号SS~SSの各々に係るドップラ周波数理論値f(^) dop_A_obsを算出する。次いで、ドップラ残差算出部13は、以下の式(10)により、衛星信号SS~SSの各々に係るドップラ残差f dop_A_resiを算出する。これにより、衛星信号処理部11の内部クロックの精度が低い場合であっても、ドップラ残差f dop_A_resiを算出することができる。
Figure JPOXMLDOC01-appb-I000009

Figure JPOXMLDOC01-appb-I000010
 次に、衛星信号判定装置100の他の変形例について説明する。
 衛星信号SS~SSに非直達波信号が多く含まれている場合、アンテナ方向推定部12により算出されるアンテナ速度ベクトル推定値の誤差が大きくなる可能性がある。かかる誤差を小さくする観点から、アンテナ方向推定部12は、いわゆる「ロバスト推定」をアンテナ速度ベクトル推定値の算出に用いるものであっても良い。具体的には、例えば、アンテナ方向推定部12は、RANSAC(Random Sample Consensus)法、最小メジアン法又はM推定法を用いるものであっても良い。
 RANSAC法は、以下のように用いられる。すなわち、アンテナ方向推定部12は、N個の測位衛星PS~PSのうちのk個の測位衛星をランダムに選択する(k<N)。アンテナ方向推定部12は、当該選択されたk個の測位衛星に対応するk個の衛星信号に基づき、最小二乗法によりアンテナ速度ベクトル推定値を算出する。当該算出されたアンテナ速度ベクトル推定値を用いて、N個の測位衛星PS~PSの各々に係るドップラ残差が算出される。これらのドップラ残差は、例えば、ドップラ残差算出部13により算出される。アンテナ方向推定部12は、当該算出されたドップラ残差を取得する。
 これらの手順が所定回繰り返し実行される。これにより、N個のドップラ残差が所定回分取得される。アンテナ方向推定部12は、当該取得された所定回分のドップラ残差に基づき、N個のドップラ残差のうちの所定値以下のドップラ残差の個数が最も大きい回におけるアンテナ速度ベクトル推定値を採用する。
 最小メジアン法は、以下のように用いられる。すなわち、アンテナ方向推定部12は、N個の測位衛星PS~PSのうちのk個の測位衛星をランダムに選択する。アンテナ方向推定部12は、当該選択されたk個の測位衛星に対応するk個の衛星信号に基づき、最小二乗法によりアンテナ速度ベクトル推定値を算出する。当該算出されたアンテナ速度ベクトル推定値を用いて、N個の測位衛星PS~SSの各々に係るドップラ残差が算出される。これらのドップラ残差は、例えば、ドップラ残差算出部13により算出される。アンテナ方向推定部12は、当該算出されたドップラ残差を取得する。
 これらの手順が所定回繰り返し実行される。これにより、N個のドップラ残差が所定回分取得される。アンテナ方向推定部12は、当該取得された所定回分のドップラ残差に基づき、N個のドップラ残差の中央値が最も大きい回におけるアンテナ速度ベクトル推定値を採用する。
 M推定法は、以下のように用いられる。すなわち、アンテナ方向推定部12は、上記式(2)代えて、以下の式(11)を用いる。以下の式(11)は、上記式(2)に係る行列式に対して、重みWdopを付与してなるものである。
Figure JPOXMLDOC01-appb-I000011
 アンテナ方向推定部12が上記式(11)に基づく最小二乗法によりアンテナ速度ベクトルを算出する処理、ドップラ残差算出部13が当該算出されたアンテナ速度ベクトルを用いてN個の衛星信号SS~SSの各々に係るドップラ残差を算出する処理、及びアンテナ方向推定部12が当該算出されたドップラ残差に基づき重みWdopを更新する処理が所定回繰り返し実行される。重みWdopの更新は、例えば、TukeyのBiweight推定法によるものである。このとき、重みWdopは、大きいドップラ残差に対応する測位衛星に係る観測値に付与されるときは小さくなり、かつ、小さいドップラ残差に対応する測位衛星に係る観測値に付与されるときは大きくなるものである。
 これらの方法(すなわちRANSAC法、最小メジアン法又はM推定法)を用いることにより、大きい誤差を含む観測値の影響を低減することができる。この結果、アンテナ速度ベクトル推定値の誤差を小さくすることができる。
 次に、衛星信号判定装置100の他の変形例について説明する。
 上記のとおり、アンテナ方向推定部12は、最小二乗法によりアンテナ速度ベクトル推定値を算出するものであっても良い。この場合、単一時刻における観測データが用いられる。これに対して、アンテナ方向推定部12は、カルマンフィルタによりアンテナ速度ベクトル推定値を算出するものであっても良い。この場合、複数時刻における観測データが用いられる。
 すなわち、この場合、アンテナ速度ベクトルは、以下の式(12)により一次マルコフ過程としてモデル化される。かかる式(12)が状態方程式に用いられる。ここで、τは、時定数を示している。また、ωx(・)Aは、アンテナ2の方向に関するプロセスノイズベクトルを示している。

Figure JPOXMLDOC01-appb-I000012
 また、上記式(2)又は上記式(8)に所定の観測雑音を加えてなる数式が観測方程式に用いられる。これにより、カルマンフィルタによるアンテナ速度ベクトルの推定を実現することができる。
 なお、かかる推定においては、アンテナ速度ベクトルが状態量ベクトルに含まれるのはもちろんのこと、アンテナ位置が状態量ベクトルに含まれるものであっても良い。また、クロック誤差の時間微分量等が状態量ベクトルに含まれるものであっても良い。
 次に、衛星信号判定装置100の他の変形例について説明する。
 判定部15は、衛星信号SS~SSの各々が直達波信号であるか否かを判定するのに代えて(すなわち測位衛星PS~PSの各々が直達波受信衛星であるか否かを判定するのに代えて)、アンテナ2がオープンスカイ環境に設置されているか否かを判定するものであっても良い。また、判定部15は、個々の直達波受信衛星を示す識別信号を出力するのに代えて、当該判定の結果を示す信号(以下「判定結果信号」という。)を出力するものであっても良い。
 この場合、ドップラ残差算出部13は、衛星信号SS~SSの各々に係るドップラ残差f dop_A_resiを算出した後、これらのドップラ残差f dop_A_resiの平方和RSSdopを算出する。ドップラ残差算出部13は、当該算出された平方和RSSdopを判定部15に出力する。平方和RSSdopは、以下の式(13)により算出される。

Figure JPOXMLDOC01-appb-I000013
 また、ドップラ閾値設定部14は、衛星信号SS~SSの各々に係るドップラ閾値f thre(ele,SNR)を設定した後、これらのドップラ閾値f thre(ele,SNR)の平方和RSSdop_threを算出する。ドップラ閾値設定部14は、当該算出された平方和RSSdop_threを判定部15に出力する。平方和RSSdop_threは、以下の式(14)により算出される。

Figure JPOXMLDOC01-appb-I000014
 判定部15は、ドップラ残差算出部13により出力された平方和RSSdopを取得するとともに、ドップラ閾値設定部14により出力された平方和RSSdop_threを取得する。判定部15は、当該取得された平方和RSSdopを当該取得された平方和RSSdop_threと比較する。
 平方和RSSdopが平方和RSSdop_thre以下である場合、判定部15は、アンテナ2がオープンスカイ環境に設置されていると判定する。他方、平方和RSSdopが平方和RSSdop_threよりも大きい場合、判定部15は、アンテナ2がオープンスカイ環境と異なる環境(以下「非オープンスカイ環境」という。)に設置されていると判定する。
 以上のように、実施の形態1に係る衛星信号受信装置200は、複数個の測位衛星PS~PSによりそれぞれ送信された複数個の衛星信号SS~SSを受信するアンテナ2と、アンテナ2に係るアンテナ速度ベクトル推定値を算出するアンテナ方向推定部12と、複数個の衛星信号SS~SSの各々について、アンテナ速度ベクトル推定値を用いてドップラ周波数理論値を算出して、ドップラ周波数理論値とドップラ周波数観測値との差分を示すドップラ残差を算出するドップラ残差算出部13と、複数個の衛星信号SS~SSの各々について、ドップラ残差に対する比較用のドップラ閾値を設定するドップラ閾値設定部14と、ドップラ残差をドップラ閾値と比較することにより、複数個の衛星信号SS~SSの各々が直達波信号であるか否かを判定する判定部15と、を備える。これにより、移動体1が移動中であるか否かにかかわらず、当該判定をすることができる。また、移動体1の移動方向にかかわらず、当該判定をすることができる。
 また、衛星信号受信装置200は、複数個の衛星信号SS~SSを用いて、複数個の測位衛星PS~PSに係る衛星配置、ドップラ周波数観測値、複数個の衛星信号SS~SSの各々に係る信号対雑音比観測値、及びアンテナ2に係るアンテナ位置を検出する衛星信号処理部11を備え、アンテナ方向推定部12は、衛星配置、ドップラ周波数観測値及びアンテナ位置を用いてアンテナ速度ベクトル推定値を算出する。これにより、アンテナ速度ベクトル推定値を算出することができる。
 また、衛星配置に基づき複数個の測位衛星PS~PSの各々に係る衛星位置ベクトル及び複数個の測位衛星PS~PSの各々に係る衛星速度ベクトルが検出されるものであり、かつ、アンテナ位置に基づきアンテナ2に係るアンテナ位置ベクトルが検出されるものであり、ドップラ残差算出部13は、衛星位置ベクトル、衛星速度ベクトル、アンテナ位置ベクトル及びアンテナ速度ベクトル推定値を用いてドップラ周波数理論値を算出する。これにより、ドップラ周波数理論値を算出することができる。
 また、アンテナ方向推定部12は、最小二乗法又はカルマンフィルタによりアンテナ速度ベクトル推定値を算出する。これにより、アンテナ速度ベクトル推定値を算出することができる。
 また、アンテナ方向推定部12は、RANSAC法、最小メジアン法又はM推定法によりアンテナ速度ベクトル推定値を算出する。すなわち、アンテナ方向推定部12は、ロバスト推定によりアンテナ速度ベクトル推定値を算出する。これにより、衛星信号SS~SSに非直達波信号が多く含まれている場合であっても、アンテナ速度ベクトル推定値を正確に算出することができる。
 また、衛星配置を用いて複数個の測位衛星PS~PSの各々に係る衛星仰角が算出されるものであり、ドップラ閾値設定部14は、ドップラ閾値テーブルに含まれる複数個のドップラ閾値のうちの衛星仰角及び信号対雑音比観測値に対応する1個以上のドップラ閾値を選択して、当該選択された1個以上のドップラ閾値に基づきドップラ閾値を設定する。これにより、衛星仰角及び信号対雑音比観測値に応じてドップラ閾値を適切な値に設定することができる。
実施の形態2.
 図9は、実施の形態2に係る衛星信号受信装置の要部を示すブロック図である。図9を参照して、実施の形態2に係る衛星信号受信装置について説明する。なお、図9において、図1に示すブロックと同様のブロックには同一符号を付して説明を省略する。
 図9に示す如く、移動体1は、複数個のアンテナ2を有している。複数個のアンテナ2により、アンテナ2aが構成されている。また、衛星信号判定装置100aは、複数個のアンテナ2と一対一に対応する複数個の衛星信号処理部11を有している。複数個の衛星信号処理部11により、衛星信号処理部11aが構成されている。複数個の衛星信号処理部11の各々は、実施の形態1にて説明したものと同様の衛星信号処理を実行するものである。すなわち、衛星信号処理部11aは、実施の形態1にて説明したものと同様の衛星信号処理を実行するものである。
 以下、移動体1が2個のアンテナ2_A,2_Bを有しており、かつ、衛星信号判定装置100aが2個の衛星信号処理部11_A,11_Bを有している例を中心に説明する。すなわち、衛星信号処理部11_A,11_Bは、アンテナ2_A,2_Bと一対一に対応するものである。
 アンテナ姿勢推定部16は、衛星信号処理部11aにより出力された航法メッセージ、観測データ及びアンテナ位置データを取得するものである。アンテナ姿勢推定部16は、当該取得された航法メッセージ、観測データ及びアンテナ位置データを用いて、アンテナ2_A,2_Bに係る基線ベクトル推定値を算出するものである。アンテナ姿勢推定部16は、当該算出された基線ベクトル推定値を出力するものである。
 以下、アンテナ姿勢推定部16により実行される処理を総称して「アンテナ姿勢推定処理」ということがある。かかるアンテナ姿勢推定処理の詳細については、図11のフローチャートを参照して後述する。
 位相差残差算出部17は、衛星信号処理部11aにより出力された航法メッセージ、観測データ及びアンテナ位置データを取得するとともに、アンテナ姿勢推定部16により出力された基線ベクトル推定値を取得するものである。位相差残差算出部17は、当該取得された航法メッセージ、観測データ、アンテナ位置データ及び基線ベクトル推定値を用いて、衛星信号SS~SSの各々に係る位相差残差を算出するものである。位相差残差算出部17は、当該算出された位相差残差を出力するものである。
 以下、位相差残差算出部17により実行される処理を総称して「位相差残差算出処理」ということがある。かかる位相差残差算出処理の詳細については、図13のフローチャートを参照して後述する。
 位相差閾値設定部18は、衛星信号処理部11により出力された航法メッセージ、観測データ及びアンテナ位置データを取得するものである。位相差閾値設定部18は、当該取得された航法メッセージ、観測データ及びアンテナ位置データを用いて、衛星信号SS~SSの各々に係る位相差閾値を設定するものである。位相差閾値設定部18は、当該設定された位相差閾値を出力するものである。
 以下、位相差閾値設定部18により実行される処理を総称して「位相差閾値設定処理」ということがある。かかる位相差閾値設定処理の詳細については、図14のフローチャートを参照して後述する。
 判定部15aは、ドップラ残差算出部13により出力されたドップラ残差、ドップラ閾値設定部14により出力されたドップラ閾値、位相差残差算出部17により出力された位相差残差、及び位相差閾値設定部18により出力された位相差閾値を取得するものである。判定部15aは、当該取得されたドップラ残差、ドップラ閾値、位相差残差及び位相差閾値を用いて、衛星信号SS~SSの各々が直達波信号であるか否かを判定するものである。すなわち、判定部15aは、測位衛星PS~PSの各々が直達波受信衛星であるか否かを判定するものである。判定部15aは、当該判定の結果に基づき、個々の直達波受信衛星を示す識別情報を出力するものである。
 以下、判定部15aにより実行される処理を総称して「判定処理」ということがある。かかる判定処理の詳細については、図15のフローチャートを参照して後述する。
 衛星信号処理部11a、アンテナ方向推定部12、ドップラ残差算出部13、ドップラ閾値設定部14、判定部15a、アンテナ姿勢推定部16、位相差残差算出部17及び位相差閾値設定部18により、衛星信号判定装置100aの要部が構成されている。衛星信号判定装置100aは、例えば、移動体1に設けられている。アンテナ2a及び衛星信号判定装置100aにより、衛星信号受信装置200aの要部が構成されている。
 衛星信号判定装置100aの要部のハードウェア構成は、実施の形態1にて図2を参照して説明したものと同様である。このため、図示及び説明を省略する。すなわち、衛星信号処理部11a、アンテナ方向推定部12、ドップラ残差算出部13、ドップラ閾値設定部14、判定部15a、アンテナ姿勢推定部16、位相差残差算出部17及び位相差閾値設定部18の各々の機能は、プロセッサ21及びメモリ22により実現されるものであっても良く、又は専用の処理回路23により実現されるものであっても良い。
 次に、図10のフローチャートを参照して、衛星信号受信装置200aの動作について、衛星信号判定装置100aの動作を中心に説明する。なお、図10において、図3に示すステップと同様のステップには同一符号を付している。
 まず、衛星信号処理部11aが衛星信号処理を実行する(ステップST1a)。
 次いで、アンテナ方向推定部12がアンテナ方向推定処理を実行する(ステップST2)。次いで、ドップラ残差算出部13がドップラ残差算出処理を実行する(ステップST3)。次いで、ドップラ閾値設定部14がドップラ閾値設定処理を実行する(ステップST4)。
 また、アンテナ姿勢推定部16がアンテナ姿勢推定処理を実行する(ステップST6)。次いで、位相差残差算出部17が位相差残差算出処理を実行する(ステップST7)。次いで、位相差閾値設定部18が位相差閾値設定処理を実行する(ステップST8)。
 次いで、判定部15aが判定処理を実行する(ステップST5a)。
 次に、図11のフローチャートを参照して、アンテナ姿勢推定部16によるアンテナ姿勢推定処理の詳細について説明する。
 まず、アンテナ姿勢推定部16は、衛星信号処理部11aにより出力された航法メッセージ、観測データ及びアンテナ位置データを取得する(ステップST51)。
 ここで、当該取得された航法メッセージに含まれる衛星配置に基づき、衛星位置ベクトルxが検出される。また、当該取得されたアンテナ位置データに含まれるアンテナ位置に基づき、アンテナ位置ベクトルxが検出される。
 次いで、アンテナ姿勢推定部16は、当該取得された観測データに含まれる搬送波位相観測値を用いて、衛星信号SS~SSの各々に係るアンテナ間位相差観測値φ ABを算出する(ステップST52)。すなわち、アンテナ姿勢推定部16は、衛星信号SS~SSの各々について、衛星信号処理部11_A,11_Bにより同時刻に出力された観測データに含まれる搬送波位相観測値の差分をとることにより、アンテナ間位相差観測値φ ABを算出する。
 以下、アンテナ2_A,2_B間の距離を「アンテナ間距離」という。また、衛星信号SS~SSの各々に対応する電波について、基線ベクトルに対する到来方向の角度を「信号到来角度」という。図12は、衛星信号SSに係るアンテナ間位相差(図中φ AB)、アンテナ間距離d、基線ベクトルxuAB及び信号到来角度αの対応関係を示している。このとき、以下の式(15)が成立する。ここで、λは、衛星信号SSにおける搬送波の波長を示している。

Figure JPOXMLDOC01-appb-I000015
 なお、アンテナ2_Aによる測位衛星PSに対する単位視線ベクトルは、アンテナ2_Bによる測位衛星PSに対する単位視線ベクトルと等しいとみなすことができる。上記式(15)は、かかる擬制に基づく近似式である。ここで、cosαは、単位基線ベクトルと当該擬制された単位視線ベクトルとの内積に等しい。このため、以下の式(16)が成立する。

Figure JPOXMLDOC01-appb-I000016
 上記式(16)を上記式(15)に代入することにより、以下の式(17)が得られる。

Figure JPOXMLDOC01-appb-I000017
 変数iについて(i=1~N)、上記式(17)を行列形式に変形することにより、以下の式(18)が得られる。

Figure JPOXMLDOC01-appb-I000018
 なお、上記式(18)におけるベクトル値(式中u)は、上記式(3)により定義されるものである。
 次いで、アンテナ姿勢推定部16は、上記検出された衛星位置ベクトルx及びアンテナ位置ベクトルx並びに上記算出されたアンテナ間位相差観測値φ ABを用いて、上記式(18)に基づく最小二乗法により基線ベクトルxuABを算出する。これにより、基線ベクトル推定値x(^)uABが算出される(ステップST53)。
 次いで、アンテナ姿勢推定部16は、当該算出された基線ベクトル推定値x(^)uABを出力する(ステップST54)。
 次に、図13のフローチャートを参照して、位相差残差算出部17による位相差残差算出処理の詳細について説明する。
 まず、位相差残差算出部17は、衛星信号処理部11aにより出力された航法メッセージ、観測データ及びアンテナ位置データを取得する。また、位相差残差算出部17は、アンテナ姿勢推定部16により出力された基線ベクトル推定値x(^)uABを取得する(ステップST61)。
 ここで、当該取得された航法メッセージに含まれる衛星配置に基づき、衛星位置ベクトルxが検出される。また、当該取得されたアンテナ位置データに含まれるアンテナ位置に基づき、アンテナ位置ベクトルxが検出される。
 次いで、位相差残差算出部17は、上記取得された観測データに含まれる搬送波位相観測値を用いて、衛星信号SS~SSの各々に係るアンテナ間位相差観測値φ ABを算出する(ステップST62)。位相差残差算出部17によるアンテナ間位相差観測値φ ABの算出方法は、アンテナ姿勢推定部16によるアンテナ間位相差観測値φ ABの算出方法と同様である。
 次いで、位相差残差算出部17は、上記検出された衛星位置ベクトルx及びアンテナ位置ベクトルx並びに上記取得された基線ベクトル推定値x(^)uABを用いて、衛星信号SS~SSの各々に係るアンテナ間位相差理論値φ(^) ABを算出する(ステップST63)。このとき、位相差残差算出部17は、以下の式(19)によりアンテナ間位相差理論値φ(^) ABを算出する。

Figure JPOXMLDOC01-appb-I000019
 次いで、位相差残差算出部17は、当該算出されたアンテナ間位相差理論値φ(^) AB及び上記算出されたアンテナ間位相差観測値φ ABを用いて、衛星信号SS~SSの各々に係る位相差残差φ resiを算出する(ステップST64)。このとき、位相差残差算出部17は、以下の式(20)により位相差残差φ resiを算出する。

Figure JPOXMLDOC01-appb-I000020
 次いで、位相差残差算出部17は、当該算出された位相差残差φ resiを出力する(ステップST65)。
 次に、図14のフローチャートを参照して、位相差閾値設定部18による位相差閾値設定処理の詳細について説明する。
 まず、位相差閾値設定部18は、衛星信号処理部11aにより出力された航法メッセージ、観測データ及びアンテナ位置データを取得する(ステップST71)。
 ここで、当該取得された航法メッセージに含まれる衛星位置に基づき、衛星位置ベクトルxが検出される。また、当該取得されたアンテナ位置データに基づき、アンテナ位置ベクトルxが検出される。
 次いで、位相差閾値設定部18は、当該検出された衛星位置ベクトルx及びアンテナ位置ベクトルxを用いて、測位衛星PS~PSの各々に係る衛星仰角eleを算出する(ステップST72)。
 次いで、位相差閾値設定部18は、当該算出された衛星仰角ele及び上記取得された観測データに含まれる信号対雑音比観測値SNRを用いて、衛星信号SS~SSの各々に係る位相差閾値φ thre(ele,SNR)を設定する(ステップST73)。
 ここで、位相差閾値設定部18は、位相差閾値テーブルを有している。位相差閾値設定部18は、測位衛星PS~PSの各々について(すなわち衛星信号SS~SSの各々について)、位相差閾値テーブルに含まれる複数個の位相差閾値のうちの衛星仰角ele及び信号対雑音比観測値SNRによる衛星仰角-信号対雑音比対に対応する1個の位相差閾値を選択する。位相差閾値設定部18は、当該選択された1個の位相差閾値を位相差閾値φ thre(ele,SNR)に用いる。
 次いで、位相差閾値設定部18は、当該設定された位相差閾値φ thre(ele,SNR)を出力する(ステップST74)。
 なお、位相差閾値テーブルにおける複数個の位相差閾値が離散的に定義されている場合、衛星仰角ele及び信号対雑音比観測値SNRによる衛星仰角-信号対雑音比対に対応する1個の位相差閾値を選択することが困難である場合がある。この場合、位相差閾値設定部18は、かかる衛星仰角-信号対雑音比対に対応する2個以上の位相差閾値を選択するものであっても良い。そして、位相差閾値設定部18は、当該選択された2個以上の位相差閾値に対する補間処理を実行することにより、位相差閾値φ thre(ele,SNR)を設定するものであっても良い。
 次に、図15のフローチャートを参照して、判定部15aによる判定処理の詳細について説明する。
 まず、判定部15aは、ドップラ残差算出部13により出力されたドップラ残差f dop_A_resi、ドップラ閾値設定部14により出力されたドップラ閾値f thre(ele,SNR)、位相差残差算出部17により出力された位相差残差φ resi、及び位相差閾値設定部18により出力された位相差閾値φ thre(ele,SNR)を取得する(ステップST81)。
 次いで、判定部15aは、衛星信号SS~SSの各々について、当該取得された位相差残差φ resiを当該取得された位相差閾値φ thre(ele,SNR)と比較する(ステップST82)。これにより、衛星信号SS~SSの各々が直達波候補信号であるか否かが判定される。
 すなわち、位相差残差φ resiが位相差閾値φ thre(ele,SNR)以下である場合、判定部15aは、対応する衛星信号SSが直達波候補信号であると判定する。換言すれば、この場合、判定部15aは、対応する測位衛星PSが直達波受信候補衛星であると判定する。他方、位相差残差φ resiが位相差閾値φ thre(ele,SNR)よりも大きい場合、判定部15aは、対応する衛星信号SSが非直達波信号であると判定する。すなわち、この場合、判定部15aは、対応する測位衛星PSが非直達波受信衛星であると判定する。
 次いで、判定部15aは、ステップST82における判定結果に基づき、個々の直達波候補信号について、上記取得されたドップラ残差f dop_A_resiを上記取得されたドップラ閾値f thre(ele,SNR)と比較する(ステップST83)。これにより、個々の直達波候補信号が直達波信号であるか否かが判定される。
 すなわち、ドップラ残差f dop_A_resiがドップラ閾値f thre(ele,SNR)以下である場合、判定部15aは、対応する衛星信号SSが直達波信号であると判定する。換言すれば、この場合、判定部15aは、対応する測位衛星PSが直達波受信衛星であるとする。他方、ドップラ残差f dop_A_resiがドップラ閾値f thre(ele,SNR)よりも大きい場合、判定部15aは、対応する衛星信号SSが非直達波信号であると判定する。換言すれば、この場合、判定部15aは、対応する測位衛星PSが非直達波受信衛星であると判定する。
 次いで、判定部15aは、ステップST83における判定結果に基づき、個々の直達波受信衛星を示す識別信号を出力する(ステップST84)。
 このように、衛星信号判定装置100aは、ドップラ残差f dop_A_resiをドップラ閾値f thre(ele,SNR)と比較するとともに、位相差残差φ resiを位相差閾値φ thre(ele,SNR)と比較することにより、衛星信号SS~SSの各々が直達波信号であるか否かを判定する。これにより、移動体1が移動中であるか否かにかかわらず、当該判定をすることができる。また、移動体1の移動方向にかかわらず、当該判定をすることができる。この結果、例えば、移動体1が曲線移動をしているときであっても、当該判定をすることができる。
 また、例えば、移動体1が車両により構成されているとき、走行中の路面に対して平行な面部による反射波がアンテナ2aにより受信されることがある。このような場合であっても、衛星信号SS~SSの各々が直達波信号であるか否かを正確に判定することができる。
 次に、位相差閾値テーブルの生成方法について説明する。位相差閾値テーブルは、例えば、以下のようにして生成されるものである。
 いま、アンテナ2_A,2_Bと同様の2個のアンテナがオープンスカイ環境に設置されている。かかる状態にて、測位衛星PS~PSと同様の複数個の測位衛星が衛星信号SS~SSと同様の複数個の衛星信号をそれぞれ送信する。当該2個のアンテナは、当該複数個の衛星信号を受信する。次いで、当該複数個の衛星信号に対して、衛星信号処理部11aによる衛星信号処理と同様の処理、アンテナ姿勢推定部16によるアンテナ姿勢推定処理と同様の処理、及び位相差残差算出部17による位相差残差算出処理と同様の処理が実行される。
 当該複数個の測位衛星の各々について(すなわち当該複数個の衛星信号の各々について)、衛星仰角及び信号対雑音比が異なる条件下にて、これらの手順が繰り返し実行される。これにより、衛星仰角-信号対雑音比対に対する位相差残差の確率分布が得られる。そして、この確率分布に基づき、衛星仰角-信号対雑音比対毎の位相差閾値が設定される。このようにして、位相差閾値テーブルが生成される。
 次に、衛星信号判定装置100aの変形例について説明する。
 アンテナ姿勢推定部16は、上記式(18)に基づく最小二乗法により基線ベクトルxuABを算出するとき、以下の式(21)に示す拘束条件を用いるものであっても良い。これにより、より精度の高い解を得ることができる。また、この場合、基線ベクトル推定値x(^)uABは、以下の式(22)により算出される。

Figure JPOXMLDOC01-appb-I000021

Figure JPOXMLDOC01-appb-I000022
 また、アンテナ姿勢推定部16は、上記式(18)に基づく最小二乗法により基線ベクトルxuABを算出するとき、以下のような拘束条件を用いるものであっても良い。すなわち、アンテナ姿勢推定部16は、アンテナ2aの移動方向及びアンテナ2_A,2_Bの設置位置の幾何学的関係を基線ベクトルとアンテナ速度ベクトルとの拘束条件に用いるものであっても良い。例えば、アンテナ2aが直線移動をしているとき(すなわち移動体1が直線移動をしているとき)の拘束条件は、以下の式(23)により表される。ここで、δは、基線ベクトルに対するアンテナ2aの移動方向の角度を示している。

Figure JPOXMLDOC01-appb-I000023
 次に、衛星信号判定装置100aの他の変形例について説明する。
 衛星信号SS~SSに非直達波信号が多く含まれている場合、アンテナ姿勢推定部16により算出される基線ベクトル推定値の誤差が大きくなる可能性がある。かかる誤差を小さくする観点から、アンテナ姿勢推定部16は、ロバスト推定を基線ベクトル推定値の算出に用いるものであっても良い。具体的には、例えば、アンテナ姿勢推定部16は、RANSAC法、最小メジアン法又はM推定法を用いるものであっても良い。
 RANSAC法は、以下のように用いられる。すなわち、アンテナ姿勢推定部16は、N個の測位衛星PS~SSのうちのk個の測位衛星をランダムに選択する(k<N)。アンテナ姿勢推定部16は、当該選択されたk個の測位衛星に対応するk個の衛星信号に基づき、最小二乗法により基線ベクトル推定値を算出する。当該算出された基線ベクトル推定値を用いて、N個の測位衛星PS~SSの各々に係る位相差残差が算出される。これらの位相差残差は、例えば、位相差残差算出部17により算出される。アンテナ姿勢推定部16は、当該算出された位相差残差を取得する。
 これらの手順が所定回繰り返し実行される。これにより、N個の位相差残差が所定回分取得される。アンテナ姿勢推定部16は、当該取得された所定回分の位相差残差に基づき、N個の位相差残差のうちの所定値以下の位相差残差の個数が最も大きい回における基線ベクトル推定値を採用する。
 最小メジアン法は、以下のように用いられる。すなわち、アンテナ姿勢推定部16は、N個の測位衛星PS~SSのうちのk個の測位衛星をランダムに選択する。アンテナ姿勢推定部16は、当該選択されたk個の測位衛星に対応するk個の衛星信号に基づき、最小二乗法により基線ベクトル推定値を算出する。当該算出された基線ベクトル推定値を用いて、N個の測位衛星PS~SSの各々に係る位相差残差が算出される。これらの位相差残差は、例えば、位相差残差算出部17により算出される。アンテナ姿勢推定部16は、当該算出された位相差残差を取得する。
 これらの手順が所定回繰り返し実行される。これにより、N個の位相差残差が所定回分取得される。アンテナ姿勢推定部16は、当該取得された所定回分の位相差残差に基づき、N個の位相差残差の中央値が最も大きい回における基線ベクトル推定値を採用する。
 M推定法は、以下のように用いられる。すなわち、アンテナ姿勢推定部16は、上記式(18)代えて以下の式(24)を用いる。以下の式(24)は、上記式(18)に係る行列式に対して重みWphaseを付与してなるものである。

Figure JPOXMLDOC01-appb-I000024
 アンテナ姿勢推定部16が上記式(24)に基づく最小二乗法により基線ベクトル推定値を算出する処理、位相差残差算出部17が当該算出された基線ベクトル推定値を用いてN個の衛星信号SS~SSの各々に係る位相差残差を算出する処理、及びアンテナ姿勢推定部16が当該算出された位相差残差に基づき重みWphaseを更新する処理が所定回繰り返し実行される。重みWphaseの更新は、例えば、TukeyのBiweight推定法によるものである。このとき、重みWphaseは、大きい位相差残差に対応する測位衛星に係る観測値に付与されるときは小さくなり、かつ、小さい位相差残差に対応する測位衛星に係る観測値に付与されるときは大きくなるものである。
 これらの方法(すなわちRANSAC法、最小メジアン法又はM推定法)を用いることにより、大きい誤差を含む観測値の影響を低減することができる。この結果、基線ベクトル推定値の誤差を小さくすることができる。
 次に、衛星信号判定装置100aの他の変形例について説明する。
 上記のとおり、アンテナ姿勢推定部16は、最小二乗法により基線ベクトル推定値を算出するものであっても良い。この場合、単一時刻における観測データが用いられる。これに対して、アンテナ姿勢推定部16は、カルマンフィルタにより基線ベクトル推定値を算出するものであっても良い。この場合、複数時刻における観測データが用いられる。
 すなわち、この場合、基線ベクトルは、以下の式(25)により一次マルコフ過程としてモデル化される。かかる式(25)が状態方程式に用いられる。ここで、τphaseは、時定数を示している。また、ωxuABは、単位基線ベクトルに関するプロセスノイズベクトルを示している。

Figure JPOXMLDOC01-appb-I000025
 また、上記式(18)に所定の観測雑音を加えてなる数式が観測方程式に用いられる。これにより、カルマンフィルタによる基線ベクトルの推定を実現することができる。
 なお、かかる推定においては、単位基線ベクトルが状態量ベクトルに含まれるのはもちろんのこと、アンテナ位置が状態量ベクトルに含まれるものであっても良い。また、アンテナ2aの移動速度等が状態量ベクトルに含まれるものであっても良い。
 また、アンテナ間位相差に波数の整数値成分が未知の状態にて含まれている場合、整数最小二乗法を用いて予め当該整数値が決定されるものであっても良い。整数最小二乗法には、公知の種々の方法を用いることができる。例えば、LAMBDA(Least-squares Ambiguity Decorrelation Adjustment)法が用いられる。また、この場合、アンテナ間距離が小さい値に設定されることによりアンテナ間位相差が制限されることを利用して、当該整数値が決定されるものであっても良い。例えば、アンテナ間距離が1/2波長以下の値に設定されることによりアンテナ間位相差が-0.5波長~+0.5波長の範囲内に制限されることが利用される。
 次に、衛星信号判定装置100aの他の変形例について説明する。
 判定部15aは、衛星信号SS~SSの各々が直達波信号であるか否かを判定するのに代えて(すなわち測位衛星PS~PSの各々が直達波受信衛星であるか否かを判定するのに代えて)、アンテナ2aがオープンスカイ環境に設置されているか否かを判定するものであっても良い。また、判定部15aは、個々の直達波受信衛星を示す識別信号を出力するのに代えて、当該判定の結果を示す信号(すなわち判定結果信号)を出力するものであっても良い。
 この場合、ドップラ残差算出部13は、衛星信号SS~SSの各々に係るドップラ残差f dop_A_resiを算出した後、これらのドップラ残差f dop_A_resiの平方和RSSdopを算出する。ドップラ残差算出部13は、当該算出された平方和RSSdopを判定部15aに出力する。平方和RSSdopは、上記式(13)により算出される。
 また、ドップラ閾値設定部14は、衛星信号SS~SSの各々に係るドップラ閾値f thre(ele,SNR)を設定した後、これらのドップラ閾値f thre(ele,SNR)の平方和RSSdop_threを算出する。ドップラ閾値設定部14は、当該算出された平方和RSSdop_threを判定部15aに出力する。平方和RSSdop_threは、上記式(14)により算出される。
 また、位相差残差算出部17は、衛星信号SS~SSの各々に係る位相差残差φ resiを算出した後、これらの位相差残差φ resiの平方和RSSphaseを算出する。位相差残差算出部17は、当該算出された平方和RSSphaseを判定部15aに出力する。平方和RSSphaseは、以下の式(26)により算出される。

Figure JPOXMLDOC01-appb-I000026
 また、位相差閾値設定部18は、衛星信号SS~SSの各々に係る位相差閾値φ thre(ele,SNR)を設定した後、これらの位相差閾値φ thre(ele,SNR)の平方和RSSphase_threを算出する。位相差閾値設定部18は、当該算出された平方和RSSphase_threを判定部15aに出力する。平方和RSSdop_threは、以下の式(27)により算出される。

Figure JPOXMLDOC01-appb-I000027
 判定部15aは、ドップラ残差算出部13により出力された平方和RSSdop、ドップラ閾値設定部14により出力された平方和RSSdop_thre、位相差残差算出部17により出力された平方和RSSphase及び位相差閾値設定部18により出力された平方和RSSphase_threを取得する。判定部15aは、当該取得された平方和RSSdopを当該取得された平方和RSSdop_threと比較するとともに、当該取得された平方和RSSphaseを当該取得された平方和RSSphase_threと比較する。
 平方和RSSdopが平方和RSSdop_thre以下であり、かつ、平方和RSSphaseが平方和RSSphase_thre以下である場合、判定部15aは、アンテナ2aがオープンスカイ環境に設置されていると判定する。それ以外の場合、判定部15aは、アンテナ2aが非オープンスカイ環境に設置されていると判定する。
 次に、衛星信号判定装置100aの他の変形例について説明する。
 位相差残差算出部17は、アンテナ間位相差による位相差残差に代えて、二重位相差による位相差残差を算出するものであっても良い。これにより、衛星信号処理部11_A,11_Bの各々が有する局部発振器(不図示)における初期位相成分を打ち消すことができる。
 この場合、アンテナ姿勢推定部16は、衛星信号処理部11aにより出力された観測データに含まれる搬送波位相観測値を用いて、衛星信号SS~SSの各々に係る二重位相差観測値φij ABを算出する。ここで、φij ABは、基準となる1個の衛星信号SSに対する個々の衛星信号SSに係る二重位相差観測値を示している。次いで、アンテナ姿勢推定部16は、以下の式(28)に基づく最小二乗法により基線ベクトルxuABを算出する。これにより、基線ベクトル推定値x(^)uABが算出される。

Figure JPOXMLDOC01-appb-I000028
 また、この場合、位相差残差算出部17は、衛星信号処理部11aにより出力された観測データに含まれる搬送波位相観測値を用いて、衛星信号SS~SSの各々に係る二重位相差観測値φij ABを算出する。次いで、位相差残差算出部17は、以下の式(29)により、衛星信号SS~SSの各々に係る二重位相差理論値φ(^)ij ABを算出する。

Figure JPOXMLDOC01-appb-I000029
 そのほか、衛星信号判定装置100aは、実施の形態1にて説明したものと同様の種々の変形例を採用することができる。
 次に、衛星信号受信装置200aの変形例について説明する。
 アンテナ2aは、3個以上のアンテナにより構成されているものであっても良い。この場合、3個以上のアンテナのうちの各2個のアンテナに係る基線ベクトルについて、上記の処理と同様の処理が実行されるものであっても良い。
 以上のように、実施の形態2に係る衛星信号受信装置200aにおいて、アンテナ2aは、複数個のアンテナ2_A,2_Bにより構成されており、衛星信号受信装置200aは、複数個のアンテナ2_A,2_Bに係る基線ベクトル推定値を算出するアンテナ姿勢推定部16と、複数個の衛星信号SS~SSの各々について、基線ベクトル推定値を用いてアンテナ間位相差理論値を算出して、アンテナ間位相差理論値とアンテナ間位相差観測値との差分を示す位相差残差を算出する位相差残差算出部17と、複数個の衛星信号SS~SSの各々について、位相差残差に対する比較用の位相差閾値を設定する位相差閾値設定部18と、を備え、判定部15aは、ドップラ残差をドップラ閾値と比較するとともに位相差残差を位相差閾値と比較することにより、複数個の衛星信号SS~SSの各々が直達波信号であるか否かを判定する。これにより、例えば、移動体1が車両により構成されているとき、走行中の路面に対して平行な面部による反射波がアンテナ2aにより受信された場合であっても、衛星信号SS~SSの各々が直達波信号であるか否かを正確に判定することができる。
 また、衛星信号受信装置200aにおいて、アンテナ2aは、複数個のアンテナ2_A,2_Bにより構成されており、複数個のアンテナ2_A,2_Bに係る基線ベクトル推定値を算出するアンテナ姿勢推定部16と、複数個の衛星信号SS~SSの各々について、基線ベクトル推定値を用いて二重位相差理論値を算出して、二重位相差理論値と二重位相差観測値との差分を示す位相差残差を算出する位相差残差算出部17と、複数個の衛星信号SS~SSの各々について、位相差残差に対する比較用の位相差閾値を設定する位相差閾値設定部18と、を備え、判定部15aは、ドップラ残差をドップラ閾値と比較するとともに位相差残差を位相差閾値と比較することにより、複数個の衛星信号SS~SSの各々が直達波信号であるか否かを判定する。これにより、例えば、移動体1が車両により構成されているとき、走行中の路面に対して平行な面部による反射波がアンテナ2aにより受信された場合であっても、衛星信号SS~SSの各々が直達波信号であるか否かを正確に判定することができる。
 また、衛星信号受信装置200aは、複数個の衛星信号SS~SSを用いて、複数個の測位衛星PS~PSに係る衛星配置、複数個の衛星信号SS~SSの各々に係る搬送波位相観測値、ドップラ周波数観測値、複数個の衛星信号SS~SSの各々に係る信号対雑音比観測値、及びアンテナ2aに係るアンテナ位置を検出する衛星信号処理部11aを備え、搬送波位相観測値を用いてアンテナ間位相差観測値が算出されるものであり、アンテナ姿勢推定部16は、衛星配置及びアンテナ間位相差観測値を用いて基線ベクトル推定値を算出する。これにより、基線ベクトル推定値を算出することができる。
 また、衛星配置に基づき複数個の測位衛星PS~PSの各々に係る衛星位置ベクトルが検出されるものであり、かつ、アンテナ位置に基づきアンテナ2aに係るアンテナ位置ベクトルが検出されるものであり、位相差残差算出部17は、衛星位置ベクトル、アンテナ位置ベクトル及び基線ベクトル推定値を用いてアンテナ間位相差理論値を算出する。これにより、アンテナ間位相差理論値を算出することができる。
 また、衛星信号受信装置200aは、複数個の衛星信号SS~SSを用いて、複数個の測位衛星PS~PSに係る衛星配置、複数個の衛星信号SS~SSの各々に係る搬送波位相観測値、ドップラ周波数観測値、複数個の衛星信号SS~SSの各々に係る信号対雑音比観測値、及びアンテナ2aに係るアンテナ位置を検出する衛星信号処理部11aを備え、搬送波位相観測値を用いて二重位相差観測値が算出されるものであり、アンテナ姿勢推定部は、衛星配置及び二重位相差観測値を用いて基線ベクトル推定値を算出する。これにより、基線ベクトル推定値を算出することができる。
 また、衛星配置に基づき複数個の測位衛星PS~PSの各々に係る衛星位置ベクトルが検出されるものであり、かつ、アンテナ位置に基づきアンテナ2aに係るアンテナ位置ベクトルが検出されるものであり、位相差残差算出部17は、衛星位置ベクトル、アンテナ位置ベクトル及び基線ベクトル推定値を用いて二重位相差理論値を算出する。これにより、二重位相差理論値を算出することができる。
 また、アンテナ姿勢推定部16は、最小二乗法又はカルマンフィルタにより基線ベクトル推定値を算出する。これにより、基線ベクトル推定値を算出することができる。
 また、アンテナ姿勢推定部16は、RANSAC法、最小メジアン法又はM推定法により基線ベクトル推定値を算出する。すなわち、アンテナ姿勢推定部16は、ロバスト推定により基線ベクトル推定値を算出する。これにより、衛星信号SS~SSに非直達波信号が多く含まれている場合であっても、基線ベクトル推定値を正確に算出することができる。
 また、衛星配置を用いて複数個の測位衛星PS~PSの各々に係る衛星仰角が算出されるものであり、位相差閾値設定部18は、位相差閾値テーブルに含まれる複数個の位相差閾値のうちの衛星仰角及び信号対雑音比観測値に対応する1個以上の位相差閾値を選択して、当該選択された1個以上の位相差閾値に基づき位相差閾値を設定する。これにより、衛星仰角及び信号対雑音比観測値に応じて位相差閾値を適切な値に設定することができる。
 また、アンテナ姿勢推定部16は、基線ベクトル推定値を算出するとき、アンテナ2aの移動方向及び複数個のアンテナ2_A,2_Bの設置位置の幾何学的関係をアンテナ2aに係る速度ベクトルと複数個のアンテナ2_A,2_Bに係る基線ベクトルとの拘束条件に用いる。これにより、より正確な基線ベクトル推定値を算出することができる。
実施の形態3.
 図16は、実施の形態3に係る衛星信号受信装置の要部を示すブロック図である。図16を参照して、実施の形態3に係る衛星信号受信装置について説明する。なお、図16において、図9に示すブロックと同様のブロックには同一符号を付して説明を省略する。
 図16に示す如く、衛星信号判定装置100bは、受信タイミング補正部19を有している。受信タイミング補正部19は、衛星信号処理部11aにより出力された航法メッセージ及び観測データを取得するものである。受信タイミング補正部19は、当該取得された航法メッセージ及び当該取得された観測データを用いて、衛星信号処理部11_A,11_Bの各々におけるクロック誤差を算出するものである。受信タイミング補正部19は、当該算出されたクロック誤差を用いて、当該取得された観測データに含まれる搬送波位相観測値を補正するものである。受信タイミング補正部19は、補正後の搬送波位相観測値を出力するものである。
 以下、受信タイミング補正部19により実行される処理を総称して「受信タイミング補正処理」ということがある。かかる受信タイミング補正処理の詳細については、図18のフローチャートを参照して後述する。
 位相差残差算出部17は、受信タイミング補正部19により出力された補正後の搬送波位相観測値を取得するようになっている。位相差残差算出部17は、位相差残差を算出するとき、衛星信号処理部11aにより出力された観測データに含まれる搬送波位相観測値に代えて、受信タイミング補正部19により出力された補正後の搬送波位相観測値を用いるようになっている。
 衛星信号処理部11a、アンテナ方向推定部12、ドップラ残差算出部13、ドップラ閾値設定部14、判定部15a、アンテナ姿勢推定部16、位相差残差算出部17、位相差閾値設定部18及び受信タイミング補正部19により、衛星信号判定装置100bの要部が構成されている。衛星信号判定装置100bは、例えば、移動体1に設けられている。アンテナ2a及び衛星信号判定装置100bにより、衛星信号受信装置200bの要部が構成されている。
 衛星信号判定装置100bの要部のハードウェア構成は、実施の形態1にて図2を参照して説明したものと同様である。このため、図示及び説明を省略する。すなわち、衛星信号処理部11a、アンテナ方向推定部12、ドップラ残差算出部13、ドップラ閾値設定部14、判定部15a、アンテナ姿勢推定部16、位相差残差算出部17、位相差閾値設定部18及び受信タイミング補正部19の各々の機能は、プロセッサ21及びメモリ22により実現されるものであっても良く、又は専用の処理回路23により実現されるものであっても良い。
 次に、図17のフローチャートを参照して、衛星信号受信装置200bの動作について、衛星信号判定装置100aの動作を中心に説明する。なお、図17において、図10に示すステップと同様のステップには同一符号を付している。
 まず、衛星信号処理部11aが衛星信号処理を実行する(ステップST1a)。
 次いで、アンテナ方向推定部12がアンテナ方向推定処理を実行する(ステップST2)。次いで、ドップラ残差算出部13がドップラ残差算出処理を実行する(ステップST3)。次いで、ドップラ閾値設定部14がドップラ閾値設定処理を実行する(ステップST4)。
 また、受信タイミング補正部19が受信タイミング補正処理を実行する(ステップST9)。次いで、アンテナ姿勢推定部16がアンテナ姿勢推定処理を実行する(ステップST6)。次いで、位相差残差算出部17が位相差残差算出処理を実行する(ステップST7)。次いで、位相差閾値設定部18が位相差閾値設定処理を実行する(ステップST8)。
 次いで、判定部15aが判定処理を実行する(ステップST5a)。
 次に、図18のフローチャートを参照して、受信タイミング補正部19による受信タイミング補正処理の詳細について説明する。
 まず、受信タイミング補正部19は、衛星信号処理部11aにより出力された航法メッセージ及び観測データを取得する(ステップST91)。
 次いで、受信タイミング補正部19は、当該取得された航法メッセージ及び観測データを用いて、衛星信号処理部11_Aにおけるクロック誤差Δtを算出するとともに、衛星信号処理部11_Bにおけるクロック誤差Δtを算出する(ステップST92)。
 すなわち、衛星信号判定装置100bにおいて、衛星信号処理部11_A,11_Bの各々における内部時刻は既知である。そこで、受信タイミング補正部19は、当該取得された航法メッセージ及び観測データを用いた測位処理を実行することにより、測位時刻を算出する。受信タイミング補正部19により実行される測位処理は、例えば、単独測位、RTK測位又はPPP測位によるものである。そして、受信タイミング補正部19は、衛星信号処理部11_Aにおける内部時刻と当該算出された測位時刻との差分をとることにより、クロック誤差Δtを算出する。また、受信タイミング補正部19は、衛星信号処理部11_Bにおける内部時刻と当該算出された測位時刻との差分をとることにより、クロック誤差Δtを算出する。
 次いで、受信タイミング補正部19は、当該算出されたクロック誤差Δt,Δt及び上記取得された観測データに含まれるドップラ周波数観測値を用いて、上記取得された観測データに含まれる搬送波位相観測値を補正する(ステップST93)。
 すなわち、あるエポック時刻tにおいて、衛星信号処理部11_Aにより検出された搬送波位相観測値がφであり、かつ、衛星信号処理部11_Aにより検出されたドップラ周波数観測値がfであるものとする。この場合、受信タイミング補正部19は、以下の式(30)により搬送波位相観測値φを補正する。ここで、φ1_revは、φに対する補正後の搬送波位相観測値を示している。

Figure JPOXMLDOC01-appb-I000030
 また、このエポック時刻tにおいて、衛星信号処理部11_Bにより検出された搬送波位相観測値がφであり、かつ、衛星信号処理部11_Bにより検出されたドップラ周波数観測値がfであるものとする。この場合、受信タイミング補正部19は、以下の式(31)により搬送波位相観測値φを補正する。ここで、φ2_revは、φに対する補正後の搬送波位相観測値を示している。

Figure JPOXMLDOC01-appb-I000031
 次いで、受信タイミング補正部19は、補正後の搬送波位相観測値φ,φを出力する(ステップST94)。
 上記式(30)及び上記式(31)に示す如く、受信タイミング補正部19による搬送波位相観測値φ,φの補正は、線形補間によるものである。かかる補間により、観測データに含まれる搬送波位相観測値φ,φに対応する時刻がずれている場合であっても、位相差残差の算出に用いられる搬送波位相観測値φ1_rev,φ2_revに対応する時刻を揃えることができる。このため、衛星信号処理部11_A,11_Bの内部クロックが互いに非同期である場合であっても、衛星信号SS~SSの各々が直達波信号であるか否かを正確に判定することができる。
 なお、受信タイミング補正処理における補間は、上記の具体例に限定されるものではない。例えば、受信タイミング補正部19は、複数のエポック時刻tにおける搬送波位相観測値φ,φを用いて、二次以上の線形補間を実行するものであっても良い。また、例えば、同一のエポック時刻tに検出された搬送波位相観測値φ,φが存在しない場合、受信タイミング補正部19は、あるエポック時刻tに検出された搬送波位相観測値φと、このエポック時刻tに最も近い時刻tに検出された搬送波位相観測値φとを用いて、クロック誤差はもちろんのこと、エポック時刻t,t間の時刻差を考慮した補間を実行するものであっても良い。
 そのほか、衛星信号受信装置200bは、実施の形態1にて説明したものと同様の種々の変形例を採用することができる。また、衛星信号受信装置200bは、実施の形態2にて説明したものと同様の種々の変形例を採用することができる。
 以上のように、実施の形態3に係る衛星信号受信装置200bにおいて、衛星信号処理部11aは、複数個のアンテナ2_A,2_Bに対応する複数個の衛星信号処理部11_A,11_Bにより構成されており、衛星信号受信装置200bは、複数個の衛星信号処理部11_A,11_Bの各々におけるクロック誤差を算出して、クロック誤差及びドップラ周波数観測値を用いて搬送波位相観測値の補正をする受信タイミング補正部19を備える。これにより、衛星信号処理部11_A,11_Bの内部クロックが互いに非同期である場合であっても、衛星信号SS~SSの各々が直達波信号であるか否かを正確に判定することができる。
実施の形態4.
 図19は、実施の形態4に係る位置測定装置の要部を示すブロック図である。図19を参照して、実施の形態4に係る位置測定装置について説明する。
 図19に示す如く、位置測定装置300は、アンテナ2及び衛星信号判定装置100を有している。すなわち、位置測定装置300は、衛星信号受信装置200を有している。衛星信号受信装置200は、実施の形態1にて説明したものと同様である。このため、衛星信号受信装置200についての詳細な説明は省略する。
 以下、衛星信号判定装置100により実行される処理を総称して「衛星信号判定処理」ということがある。衛星信号判定処理に含まれる個々の処理は、実施の形態1にて説明したものと同様である。このため、これらの処理についての詳細な説明は省略する。
 位置測定部31は、衛星信号判定装置100の衛星信号処理部11により出力された航法メッセージ及び観測データを取得するものである。位置測定部31は、当該取得された航法メッセージ及び観測データを用いて、移動体1の位置を測定する処理(以下「位置測定処理」という。)を実行するものである。
 ここで、位置測定部31は、衛星信号判定装置100の判定部15により出力された識別信号を取得するようになっている。位置測定部31は、当該取得された識別信号を用いて、上記取得された航法メッセージ及び観測データのうちの直達波受信衛星に係る航法メッセージ及び観測データを位置測定処理に用いるようになっている。また、位置測定部31は、上記取得された航法メッセージ及び観測データのうちの非直達波受信衛星に係る航法メッセージ及び観測データを位置測定処理から除外するようになっている。
 すなわち、判定部15による判定結果に基づき、衛星信号SS~SSのうちの直達波信号が位置測定処理に用いられるようになっている。また、衛星信号SS~SSのうちの非直達波信号が位置測定処理から除外されるようになっている。このように、非直達波信号を位置測定処理から除外することにより、位置測定処理における測定誤差の発生を抑制することができる。換言すれば、直達波信号のみを位置測定処理に用いることにより、位置測定処理における測定精度の向上を図ることができる。
 衛星信号受信装置200及び位置測定部31により、位置測定装置300の要部が構成されている。
 次に、図20を参照して、位置測定装置300の要部のハードウェア構成について説明する。
 図20Aに示す如く、位置測定装置300は、アンテナ2、プロセッサ41及びメモリ42を有している。メモリ42には、衛星信号判定装置100及び位置測定部31の機能を実現するためのプログラムが記憶されている。かかるプログラムをプロセッサ41が読み出して実行することにより、衛星信号判定装置100及び位置測定部31の機能が実現される。
 または、図20Bに示す如く、位置測定装置300は、アンテナ2及び処理回路43を有している。この場合、衛星信号判定装置100及び位置測定部31の機能は、専用の処理回路43により実現される。
 または、位置測定装置300は、アンテナ2、プロセッサ41、メモリ42及び処理回路43を有している(不図示)。この場合、衛星信号判定装置100及び位置測定部31の機能のうちの一部の機能がプロセッサ41及びメモリ42により実現されるとともに、残余の機能が専用の処理回路43により実現される。
 プロセッサ41は、1個又は複数個のプロセッサにより構成されている。個々のプロセッサは、例えば、CPU、GPU、マイクロプロセッサ、マイクロコントローラ又はDSPを用いたものである。
 メモリ42は、1個又は複数個の不揮発性メモリにより構成されている。または、メモリ42は、1個又は複数個の不揮発性メモリ及び1個又は複数個の揮発性メモリにより構成されている。すなわち、メモリ42は、1個又は複数個のメモリにより構成されている。個々のメモリは、例えば、半導体メモリ又は磁気ディスクを用いたものである。より具体的には、個々の揮発性メモリは、例えば、RAMを用いたものである。また、個々の不揮発性メモリは、例えば、ROM、フラッシュメモリ、EPROM、EEPROM、ソリッドステートドライブ又はハードディスクドライブを用いたものである。
 処理回路43は、1個又は複数個のデジタル回路により構成されている。または、処理回路43は、1個又は複数個のデジタル回路及び1個又は複数個のアナログ回路により構成されている。すなわち、処理回路43は、1個又は複数個の処理回路により構成されている。個々の処理回路は、例えば、ASIC、PLD、FPGA、SoC又はシステムLSIを用いたものである。
 次に、図21のフローチャートを参照して、位置測定装置300の動作について、衛星信号判定装置100及び位置測定部31の動作を中心に説明する。
 まず、衛星信号判定装置100が衛星信号判定処理を実行する(ステップST101)。次いで、位置測定部31が位置測定処理を実行する(ステップST102)。
 次に、図22を参照して、位置測定装置300の変形例について説明する。
 図22に示す如く、位置測定装置300は、衛星信号受信装置200に代えて衛星信号受信装置200aを有するものであっても良い。衛星信号受信装置200aは、実施の形態2にて説明したものと同様である。このため、衛星信号受信装置200aについての詳細な説明は省略する。
 次に、図23を参照して、位置測定装置300の他の変形例について説明する。
 図23に示す如く、位置測定装置300は、衛星信号受信装置200に代えて衛星信号受信装置200bを有するものであっても良い。衛星信号受信装置200bは、実施の形態3にて説明したものと同様である。このため、衛星信号受信装置200bについての詳細な説明は省略する。
 次に、位置測定装置300の他の変形例について説明する。
 実施の形態1にて説明したとおり、判定部15は、アンテナ2がオープンスカイ環境に設置されているか否かを判定するものであっても良い。また、実施の形態2にて説明したとおり、判定部15aは、アンテナ2aがオープンスカイ環境に設置されているか否かを判定するものであっても良い。
 この場合、位置測定部31は、判定部15(又は判定部15a)により出力された判定結果信号を取得する。位置測定部31は、当該取得された判定結果信号を用いて、アンテナ2(又はアンテナ2a)がオープンスカイ環境に設置されているとき、位置測定処理を実行する。他方、アンテナ2(又はアンテナ2a)が非オープンスカイ環境に設置されているとき、位置測定部31は、位置測定処理の実行をキャンセルする。これにより、上記の例と同様に、直達波信号を位置測定処理に用いることができ、かつ、非直達波信号を位置測定処理から除外することができる。
 そのほか、位置測定装置300における衛星信号受信装置200は、実施の形態1にて説明したものと同様の種々の変形例を採用することができる。また、位置測定装置300における衛星信号受信装置200aは、実施の形態1,2にて説明したものと同様の種々の変形例を採用することができる。また、位置測定装置300における衛星信号受信装置200bは、実施の形態1~3にて説明したものと同様の種々の変形例を採用することができる。
 以上のように、実施の形態4に係る位置測定装置300は、衛星信号受信装置200、衛星信号受信装置200a又は衛星信号受信装置200bと、判定部15又は判定部15aによる判定結果に基づき、複数個の衛星信号SS~SSのうちの直達波信号を用いて位置測定処理を実行する位置測定部31と、を備え、判定部15又は判定部15aによる判定結果に基づき、複数個の衛星信号SS~SSのうちの非直達波信号が位置測定処理から除外されるものである。これにより、移動体1の位置を精度良く測定することができる。
 なお、本願発明はその発明の範囲内において、各実施の形態の自由な組み合わせ、あるいは各実施の形態の任意の構成要素の変形、もしくは各実施の形態において任意の構成要素の省略が可能である。
 本発明の衛星信号受信装置及び位置測定装置は、例えば、車両、船舶、航空機又は携帯情報端末の位置の測定に用いることができる。
 1 移動体、2 アンテナ、2_A アンテナ、2_B アンテナ、2a アンテナ、11 衛星信号処理部、11_A 衛星信号処理部、11_B 衛星信号処理部、11a 衛星信号処理部、12 アンテナ方向推定部、13 ドップラ残差算出部、14 ドップラ閾値設定部、15 判定部、15a 判定部、16 アンテナ姿勢推定部、17 位相差残差算出部、18 位相差閾値設定部、19 受信タイミング補正部、21 プロセッサ、22 メモリ、23 処理回路、31 位置測定部、41 プロセッサ、42 メモリ、43 処理回路、100 衛星信号判定装置、100a 衛星信号判定装置、100b 衛星信号判定装置、200 衛星信号受信装置、200a 衛星信号受信装置、200b 衛星信号受信装置、300 位置測定装置。

Claims (18)

  1.  複数個の測位衛星によりそれぞれ送信された複数個の衛星信号を受信するアンテナと、
     前記アンテナに係るアンテナ速度ベクトル推定値を算出するアンテナ方向推定部と、
     前記複数個の衛星信号の各々について、前記アンテナ速度ベクトル推定値を用いてドップラ周波数理論値を算出して、前記ドップラ周波数理論値とドップラ周波数観測値との差分を示すドップラ残差を算出するドップラ残差算出部と、
     前記複数個の衛星信号の各々について、前記ドップラ残差に対する比較用のドップラ閾値を設定するドップラ閾値設定部と、
     前記ドップラ残差を前記ドップラ閾値と比較することにより、前記複数個の衛星信号の各々が直達波信号であるか否かを判定する判定部と、
     を備える衛星信号受信装置。
  2.  前記アンテナは、複数個のアンテナにより構成されており、
     前記複数個のアンテナに係る基線ベクトル推定値を算出するアンテナ姿勢推定部と、
     前記複数個の衛星信号の各々について、前記基線ベクトル推定値を用いてアンテナ間位相差理論値を算出して、前記アンテナ間位相差理論値とアンテナ間位相差観測値との差分を示す位相差残差を算出する位相差残差算出部と、
     前記複数個の衛星信号の各々について、前記位相差残差に対する比較用の位相差閾値を設定する位相差閾値設定部と、を備え、
     前記判定部は、前記ドップラ残差を前記ドップラ閾値と比較するとともに前記位相差残差を前記位相差閾値と比較することにより、前記複数個の衛星信号の各々が直達波信号であるか否かを判定する
     ことを特徴とする請求項1記載の衛星信号受信装置。
  3.  前記アンテナは、複数個のアンテナにより構成されており、
     前記複数個のアンテナに係る基線ベクトル推定値を算出するアンテナ姿勢推定部と、
     前記複数個の衛星信号の各々について、前記基線ベクトル推定値を用いて二重位相差理論値を算出して、前記二重位相差理論値と二重位相差観測値との差分を示す位相差残差を算出する位相差残差算出部と、
     前記複数個の衛星信号の各々について、前記位相差残差に対する比較用の位相差閾値を設定する位相差閾値設定部と、を備え、
     前記判定部は、前記ドップラ残差を前記ドップラ閾値と比較するとともに前記位相差残差を前記位相差閾値と比較することにより、前記複数個の衛星信号の各々が直達波信号であるか否かを判定する
     ことを特徴とする請求項1記載の衛星信号受信装置。
  4.  前記複数個の衛星信号を用いて、前記複数個の測位衛星に係る衛星配置、前記ドップラ周波数観測値、前記複数個の衛星信号の各々に係る信号対雑音比観測値、及び前記アンテナに係るアンテナ位置を検出する衛星信号処理部を備え、
     前記アンテナ方向推定部は、前記衛星配置、前記ドップラ周波数観測値及び前記アンテナ位置を用いて前記アンテナ速度ベクトル推定値を算出する
     ことを特徴とする請求項1から請求項3のうちのいずれか1項記載の衛星信号受信装置。
  5.  前記衛星配置に基づき前記複数個の測位衛星の各々に係る衛星位置ベクトル及び前記複数個の測位衛星の各々に係る衛星速度ベクトルが検出されるものであり、かつ、前記アンテナ位置に基づき前記アンテナに係るアンテナ位置ベクトルが検出されるものであり、
     前記ドップラ残差算出部は、前記衛星位置ベクトル、前記衛星速度ベクトル、前記アンテナ位置ベクトル及び前記アンテナ速度ベクトル推定値を用いて前記ドップラ周波数理論値を算出する
     ことを特徴とする請求項4記載の衛星信号受信装置。
  6.  前記アンテナ方向推定部は、最小二乗法又はカルマンフィルタにより前記アンテナ速度ベクトル推定値を算出することを特徴とする請求項4記載の衛星信号受信装置。
  7.  前記アンテナ方向推定部は、RANSAC法、最小メジアン法又はM推定法により前記アンテナ速度ベクトル推定値を算出することを特徴とする請求項4記載の衛星信号受信装置。
  8.  前記衛星配置を用いて前記複数個の測位衛星の各々に係る衛星仰角が算出されるものであり、
     前記ドップラ閾値設定部は、ドップラ閾値テーブルに含まれる複数個のドップラ閾値のうちの前記衛星仰角及び前記信号対雑音比観測値に対応する1個以上のドップラ閾値を選択して、当該選択された1個以上のドップラ閾値に基づき前記ドップラ閾値を設定する
     ことを特徴とする請求項4記載の衛星信号受信装置。
  9.  前記複数個の衛星信号を用いて、前記複数個の測位衛星に係る衛星配置、前記複数個の衛星信号の各々に係る搬送波位相観測値、前記ドップラ周波数観測値、前記複数個の衛星信号の各々に係る信号対雑音比観測値、及び前記アンテナに係るアンテナ位置を検出する衛星信号処理部を備え、
     前記搬送波位相観測値を用いて前記アンテナ間位相差観測値が算出されるものであり、
     前記アンテナ姿勢推定部は、前記衛星配置及び前記アンテナ間位相差観測値を用いて前記基線ベクトル推定値を算出する
     ことを特徴とする請求項2記載の衛星信号受信装置。
  10.  前記衛星配置に基づき前記複数個の測位衛星の各々に係る衛星位置ベクトルが検出されるものであり、かつ、前記アンテナ位置に基づき前記アンテナに係るアンテナ位置ベクトルが検出されるものであり、
     前記位相差残差算出部は、前記衛星位置ベクトル、前記アンテナ位置ベクトル及び前記基線ベクトル推定値を用いて前記アンテナ間位相差理論値を算出する
     ことを特徴とする請求項9記載の衛星信号受信装置。
  11.  前記複数個の衛星信号を用いて、前記複数個の測位衛星に係る衛星配置、前記複数個の衛星信号の各々に係る搬送波位相観測値、前記ドップラ周波数観測値、前記複数個の衛星信号の各々に係る信号対雑音比観測値、及び前記アンテナに係るアンテナ位置を検出する衛星信号処理部を備え、
     前記搬送波位相観測値を用いて前記二重位相差観測値が算出されるものであり、
     前記アンテナ姿勢推定部は、前記衛星配置及び前記二重位相差観測値を用いて前記基線ベクトル推定値を算出する
     ことを特徴とする請求項3記載の衛星信号受信装置。
  12.  前記衛星配置に基づき前記複数個の測位衛星の各々に係る衛星位置ベクトルが検出されるものであり、かつ、前記アンテナ位置に基づき前記アンテナに係るアンテナ位置ベクトルが検出されるものであり、
     前記位相差残差算出部は、前記衛星位置ベクトル、前記アンテナ位置ベクトル及び前記基線ベクトル推定値を用いて前記二重位相差理論値を算出する
     ことを特徴とする請求項11記載の衛星信号受信装置。
  13.  前記アンテナ姿勢推定部は、最小二乗法又はカルマンフィルタにより前記基線ベクトル推定値を算出することを特徴とする請求項9又は請求項11記載の衛星信号受信装置。
  14.  前記アンテナ姿勢推定部は、RANSAC法、最小メジアン法又はM推定法により前記基線ベクトル推定値を算出することを特徴とする請求項9又は請求項11記載の衛星信号受信装置。
  15.  前記衛星配置を用いて前記複数個の測位衛星の各々に係る衛星仰角が算出されるものであり、
     前記位相差閾値設定部は、位相差閾値テーブルに含まれる複数個の位相差閾値のうちの前記衛星仰角及び前記信号対雑音比観測値に対応する1個以上の位相差閾値を選択して、当該選択された1個以上の位相差閾値に基づき前記位相差閾値を設定する
     ことを特徴とする請求項9又は請求項11記載の衛星信号受信装置。
  16.  前記アンテナ姿勢推定部は、前記基線ベクトル推定値を算出するとき、前記アンテナの移動方向及び前記複数個のアンテナの設置位置の幾何学的関係を前記アンテナに係る速度ベクトルと前記複数個のアンテナに係る基線ベクトルとの拘束条件に用いることを特徴とする請求項9又は請求項11記載の衛星信号受信装置。
  17.  前記衛星信号処理部は、前記複数個のアンテナに対応する複数個の衛星信号処理部により構成されており、
     前記複数個の衛星信号処理部の各々におけるクロック誤差を算出して、前記クロック誤差及び前記ドップラ周波数観測値を用いて前記搬送波位相観測値の補正をする受信タイミング補正部を備える
     ことを特徴とする請求項9又は請求項11記載の衛星信号受信装置。
  18.  請求項1から請求項3のうちのいずれか1項記載の衛星信号受信装置と、
     前記判定部による判定結果に基づき、前記複数個の衛星信号のうちの直達波信号を用いて位置測定処理を実行する位置測定部と、を備え、
     前記判定部による判定結果に基づき、前記複数個の衛星信号のうちの非直達波信号が前記位置測定処理から除外されるものである
     ことを特徴とする位置測定装置。
PCT/JP2019/039115 2019-10-03 2019-10-03 衛星信号受信装置及び位置測定装置 WO2021064939A1 (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP2021550879A JP7154433B2 (ja) 2019-10-03 2019-10-03 衛星信号受信装置及び位置測定装置
PCT/JP2019/039115 WO2021064939A1 (ja) 2019-10-03 2019-10-03 衛星信号受信装置及び位置測定装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2019/039115 WO2021064939A1 (ja) 2019-10-03 2019-10-03 衛星信号受信装置及び位置測定装置

Publications (1)

Publication Number Publication Date
WO2021064939A1 true WO2021064939A1 (ja) 2021-04-08

Family

ID=75337919

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2019/039115 WO2021064939A1 (ja) 2019-10-03 2019-10-03 衛星信号受信装置及び位置測定装置

Country Status (2)

Country Link
JP (1) JP7154433B2 (ja)
WO (1) WO2021064939A1 (ja)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113109850A (zh) * 2021-05-14 2021-07-13 长沙学院 一种gnss卫星导航免定位快速粗略频差估计方法

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH11118903A (ja) * 1997-10-16 1999-04-30 Matsushita Electric Ind Co Ltd 位置検出装置
JP2001264409A (ja) * 2000-03-21 2001-09-26 Clarion Co Ltd カーナビゲーション装置におけるマルチパス判定方法
JP2006242911A (ja) * 2005-03-07 2006-09-14 Denso Corp 位置検出装置
JP2008216062A (ja) * 2007-03-05 2008-09-18 Japan Radio Co Ltd 移動体姿勢計測装置
JP2008298443A (ja) * 2007-05-29 2008-12-11 Mitsubishi Electric Corp マルチパス検出装置、測位装置、姿勢方位標定装置、マルチパス検出方法およびマルチパス検出プログラム
JP2014077769A (ja) * 2012-10-12 2014-05-01 Toyota Central R&D Labs Inc センサ傾斜判定装置及びプログラム
US20180011200A1 (en) * 2016-07-06 2018-01-11 Qualcomm Incorporated Satellite signal exclusion based on doppler information
JP2019168257A (ja) * 2018-03-22 2019-10-03 株式会社豊田中央研究所 移動体情報推定装置及びプログラム

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH11118903A (ja) * 1997-10-16 1999-04-30 Matsushita Electric Ind Co Ltd 位置検出装置
JP2001264409A (ja) * 2000-03-21 2001-09-26 Clarion Co Ltd カーナビゲーション装置におけるマルチパス判定方法
JP2006242911A (ja) * 2005-03-07 2006-09-14 Denso Corp 位置検出装置
JP2008216062A (ja) * 2007-03-05 2008-09-18 Japan Radio Co Ltd 移動体姿勢計測装置
JP2008298443A (ja) * 2007-05-29 2008-12-11 Mitsubishi Electric Corp マルチパス検出装置、測位装置、姿勢方位標定装置、マルチパス検出方法およびマルチパス検出プログラム
JP2014077769A (ja) * 2012-10-12 2014-05-01 Toyota Central R&D Labs Inc センサ傾斜判定装置及びプログラム
US20180011200A1 (en) * 2016-07-06 2018-01-11 Qualcomm Incorporated Satellite signal exclusion based on doppler information
JP2019168257A (ja) * 2018-03-22 2019-10-03 株式会社豊田中央研究所 移動体情報推定装置及びプログラム

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113109850A (zh) * 2021-05-14 2021-07-13 长沙学院 一种gnss卫星导航免定位快速粗略频差估计方法
CN113109850B (zh) * 2021-05-14 2022-07-15 长沙学院 一种gnss卫星导航免定位快速粗略频差估计方法

Also Published As

Publication number Publication date
JP7154433B2 (ja) 2022-10-17
JPWO2021064939A1 (ja) 2021-04-08

Similar Documents

Publication Publication Date Title
US11441907B2 (en) Positioning device and positioning method
CN109738917B (zh) 一种北斗变形监测中的多路径误差削弱方法及装置
US8120527B2 (en) Satellite differential positioning receiver using multiple base-rover antennas
JP5673071B2 (ja) 位置推定装置及びプログラム
JP4781313B2 (ja) マルチパス検出装置、測位装置、姿勢方位標定装置、マルチパス検出方法およびマルチパス検出プログラム
JP4655139B2 (ja) 移動体位置測位装置
EP2564238B1 (en) System and method for determining the heading angle of a vehicle
US20110037646A1 (en) Inter-mobile body carrier phase positioning device and method
EP2488892A1 (en) Ultra-short baseline gnss receiver
US9638806B2 (en) System and method for detecting ambiguities in satellite signals for GPS tracking of vessels
US11187812B2 (en) Positioning method and positioning terminal
JP2010256301A (ja) マルチパス判定装置及びプログラム
WO2021064939A1 (ja) 衛星信号受信装置及び位置測定装置
RU2338160C1 (ru) Способ определения параметров навигации
JP7111298B2 (ja) 衛星選択装置、及びプログラム
US8818720B2 (en) Method and apparatus of GNSS receiver heading determination
Azab et al. Precise point positioning using combined GPS/GLONASS measurements
JP4928114B2 (ja) キャリア位相相対測位装置
Dai et al. Heading-determination using the sensor-fusion based maritime PNT Unit
JP6546730B2 (ja) 衛星信号受信装置
Tien et al. Adaptive strategy-based tightly-coupled INS/GNSS integration system aided by odometer and barometer
KR101061965B1 (ko) 선박의 위성신호 미약환경에서 gps 반송파 위상의 미지정수를 검출하는 방법
JP3827598B2 (ja) 移動体位置計測システム
EP3124999B1 (en) A method and apparatus for determining an object heading
CN113759404B (zh) 一种差分定位方法及设备

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 19947817

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 2021550879

Country of ref document: JP

Kind code of ref document: A

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 19947817

Country of ref document: EP

Kind code of ref document: A1