WO2009130570A2 - Relative position detecting apparatus, and relative position detecting system - Google Patents

Relative position detecting apparatus, and relative position detecting system Download PDF

Info

Publication number
WO2009130570A2
WO2009130570A2 PCT/IB2009/005320 IB2009005320W WO2009130570A2 WO 2009130570 A2 WO2009130570 A2 WO 2009130570A2 IB 2009005320 W IB2009005320 W IB 2009005320W WO 2009130570 A2 WO2009130570 A2 WO 2009130570A2
Authority
WO
WIPO (PCT)
Prior art keywords
movable object
observation data
positioning
objects
reference movable
Prior art date
Application number
PCT/IB2009/005320
Other languages
French (fr)
Other versions
WO2009130570A3 (en
Inventor
Yasuhiro Tajima
Kazunori Kagawa
Masafumi Uchihara
Original Assignee
Toyota Jidosha Kabushiki Kaisha
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 Toyota Jidosha Kabushiki Kaisha filed Critical Toyota Jidosha Kabushiki Kaisha
Priority to US12/989,007 priority Critical patent/US8259009B2/en
Priority to DE112009001008T priority patent/DE112009001008T5/en
Priority to CN2009801145861A priority patent/CN102016625B/en
Publication of WO2009130570A2 publication Critical patent/WO2009130570A2/en
Publication of WO2009130570A3 publication Critical patent/WO2009130570A3/en

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42Determining position
    • G01S19/43Determining position using carrier phase measurements, e.g. kinematic positioning; using long or short baseline interferometry
    • G01S19/44Carrier phase ambiguity resolution; Floating ambiguity; LAMBDA [Least-squares AMBiguity Decorrelation Adjustment] method
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/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/20Integrity monitoring, fault detection or fault isolation of space segment
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42Determining position
    • G01S19/51Relative positioning
    • 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
    • G01S5/00Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/0009Transmission of position information to remote stations
    • G01S5/0072Transmission between mobile stations, e.g. anti-collision systems

Definitions

  • the invention relates to a relative position detecting apparatus which is mounted in a movable object and detects the relative position of that movable object with respect to another moving object, as well as to a relative position detecting system made up of three or more movable objects each of which is provided with the relative position detecting apparatus.
  • apparatuses that observe for satellite signals, obtain the observed data, and calculate the position of a movable object by performing a positioning calculation are used in vehicle navigation systems, marine vessels, and mobile phones and the like.
  • Single point positioning is a method which calculates pseudo ranges to a plurality of satellites based on the observed data obtained at a single observation point, and then calculates the position of the observation point according to the principle of triangulation.
  • Interferometric positioning is a method which calculates the position of a measure point by obtaining a base vector from a known point to the measure point based on the observed data obtained at the observation point.
  • Interferometric positioning uses a carrier phase with a short cycle compared to a C/A code that is normally used in single point positioning. Therefore, the frequency (i.e., the integer bias) from the satellite to the observation point must be specified.
  • JP-A-2003-270319 describes an invention relating to this interferometric positioning.
  • JP-A-2003-270319 describes a method for calculating satellite positioning that involves the following steps. That is, for a satellite signal from the same satellite from which signals are received at a position on a reference side and a position on a positioning side (i.e., a measuring side), a relational expression between i) a carrier phase difference, ii) a carrier phase bias of an integer included in the carrier phase difference, iii) a phase difference between the positioning side and the reference side related to a reference phase by observation of the carrier phase, iv) the position of the satellite sending the satellite signal received by the reference side and the positioning side, and v) the positions of the reference side and the positioning side, is obtained.
  • a first aspect of the invention relates to a relative position detecting apparatus which is mounted in one movable object and detects the relative position of the one movable object with respect to another movable object.
  • This relative position detecting apparatus includes observation data obtaining means for obtaining observation data by observing a satellite signal, communicating means for communicating with the other movable object, positioning calculating means for performing a positioning calculation using the observation data obtained by the observation data obtaining means, and observation data received from the other movable object by the communicating means, and reliability determining means for determining the reliability of the results of the positioning calculation performed by the positioning calculating means.
  • the communicating means transmits data that includes the observation data obtained by the observation data obtaining means to the other movable objects; when the one movable object is the second non-reference movable object, the positioning calculating means calculates the relative position of the one movable object with respect to the reference movable object by performing interferometric positioning that uses the obtained observation data and data that includes observation data received from the reference movable object, and the communicating means transmits data that includes an integer bias calculated in the interferometric positioning to the first non-reference movable
  • the relative positions among three or more movable objects can be obtained by interferometric positioning, and the reliability of the interferometric positioning can be efficiently determined.
  • the relative position detecting apparatus it may be determined whether the one movable object is the reference movable object based on communication with the other movable objects.
  • the relative position detecting apparatus when the one movable object is one of the non-reference movable objects, it may be determined whether the one movable object is the first non-reference movable object or the second non-reference movable object based on communication with the other one or more non-reference movable objects.
  • a second aspect of the invention relates to a relative position detecting apparatus which is mounted in one movable object and detects the relative position of the one movable object with respect to another movable object.
  • This relative position detecting apparatus includes observation data obtaining means for obtaining observation data by observing a satellite signal, communicating means for communicating with the other movable object, positioning calculating means for performing a positioning calculation using the observation data obtained by the observation data obtaining means, and observation data received from the other movable object by the communicating means, and reliability determining means for determining the reliability of the results of the positioning calculation performed by the positioning calculating means.
  • the communicating means transmits data that includes the observation data obtained by the observation data obtaining means to the other movable objects.
  • the positioning calculating means calculates the relative position of the one movable object with respect to the reference movable object by performing interferometric positioning using the obtained observation data and the data that includes observation data received from the reference movable object, and the reliability determining means performs a ratio test on the interferometric positioning, and if a ratio value
  • the communicating means may transmit and receive observation data to and from the other one or more non-reference movable objects, and the reliability determining means may determine the reliability based on a comparison of i) the results of interferometric positioning regarding the relationship between the one movable object and the reference movable object, and ii) the results of the interferometric positioning regarding the relationship between the one movable object and the other one or more non-reference movable objects performed by the positioning calculating means or the results of the interferometric positioning performed by the other one or more non-reference movable objects.
  • the communicating means may transmit and receive observation data to and from the other one or more non-reference movable objects, and the reliability determining means may determine the reliability based on a comparison of i) the results of interferometric positioning regarding the relationship between the one movable object and the reference movable object, and ii) the results of the interferometric positioning regarding the relationship between the one movable object and the other one or more non-reference movable
  • the results that are to be compared with the results of interferometric positioning regarding the relationship between the one movable object and the reference movable object are the results of interferometric positioning regarding the relationship between the one movable object and the other one or more non-reference movable objects or the results of interferometric positioning performed by the other one or more non-reference movable objects.
  • a third aspect of the invention relates to a relative position detecting system that includes three or more movable objects each of which is provided with observation data obtaining means for obtaining observation data by observing a satellite signal, communicating means for communicating with the other movable objects, and positioning calculating means for performing a positioning calculation using the observation data obtained by the observation data obtaining means and observation data received from the other movable objects by the communicating means.
  • the reference movable object transmits data that includes the observation data obtained by the observation data obtaining means to the other movable objects;
  • the positioning calculating means of the non-reference movable objects calculate the relative positions of the non-reference movable objects with respect to the reference movable object by performing interferometric positioning using the obtained observation data and data that includes observation data received from the reference movable object;
  • the second non-reference movable object transmits data that includes an integer bias calculated in the interferometric positioning to the first non-reference movable objects and receives the results from determining the reliability of the interferometric positioning based
  • the relative positions among three or more movable objects can be obtained by interferometric positioning, and the reliability of the interferometric positioning can be efficiently determined.
  • one of the movable objects may be determined to be the reference movable object and the other movable objects may be determined to be the non-reference movable objects by the three or more movable objects that make up the relative position detecting system communicating with each another.
  • the relative position detecting system it may be determined, for each of the non-reference movable objects, whether the non-reference movable object is the first non-reference movable object or the second non-reference movable object by the non-reference movable objects communicating with each other.
  • a fourth aspect of the invention relates to a relative position detecting system that includes three or more movable objects each of which is provided with observation data obtaining means for obtaining observation data by observing a satellite signal, communicating means for communicating with the other movable objects, and positioning calculating means for performing a positioning calculation using the observation data obtained by the observation data obtaining means and observation data received from the other movable objects by the communicating means.
  • the reference movable object transmits data that includes the observation data obtained by the observation data obtaining means to the other movable objects; and one of the non-reference movable objects uses the positioning calculating means to calculate the relative position of the non-reference movable object with respect to the reference movable object by performing interferometric positioning using the obtained observation data and data that includes the observation data received from the reference movable object, and performs a ratio test on the interferometric positioning, and if the ratio value of the performed ratio test is equal to or less than a predetermined value, identifies the satellite signal related to the observation data responsible for
  • one of the movable objects may be determined to be the reference movable object and the other movable objects may be determined to be the non-reference movable objects by the three or more movable objects that make up the relative position detecting system communicating with each another.
  • the non-reference movable object may transmit and receive observation data to and from the other one or more non-reference movable objects, perform interferometric positioning regarding the relationship with the other one or more non-reference movable objects, and make a reliability determination based on a comparison of i) the results of interferometric positioning regarding the relationship with the reference movable object, and ii) the results of the performed interferometric positioning or the results of the interferometric positioning performed by the other one or more non-reference movable objects, or receive reliability determination results from the one of the other one or more non-reference movable objects.
  • the non-reference movable objects may communicate with each other and each non-reference movable object may determine whether to perform interferometric positioning regarding the relationship with the other one or more non-reference movable objects or have one of the other one or more non-reference movable objects perform interferometric positioning. Further, observation data of a satellite signal not used in the interferometric positioning regarding the relationship with the reference movable object may be used in the interferometric positioning regarding the relationship with the other one or more non-reference movable objects.
  • This invention makes it possible to provide a relative position detecting apparatus and a relative position detecting system capable of obtaining the relative positions of three or more movable objects using interferometric positioning, as well as efficiently determining the reliability of that interferometric positioning.
  • FIG 1 is a view showing a frame format of the system structure of a relative position detecting system according to a first example embodiment of the invention
  • FIG 2 is a view showing an example structure of a relative position detecting apparatus according to the first example embodiment of the invention
  • FIG 3 is a view showing how processing performed by vehicles is shared in the relative position detecting system according to the first example embodiment of the invention
  • FIG 4 is a sequential diagram showing the flow of processing performed by the vehicles in the relative position detecting system according to the first example embodiment of the invention
  • FIG 5 is a flowchart illustrating the flow of a process executed by a control apparatus (mainly a reliability determining portion) of a non-reference vehicle according to a second example embodiment of the invention, which is executed after performing a RTK positioning calculation.
  • a control apparatus mainly a reliability determining portion
  • FIG. 1 is a view showing a frame formaf of the system structure of the relative position detecting system 1.
  • This relative position detecting system 1 is formed by a relative position detecting apparatus 30A, 3OB, 30C, ... being mounted in each of three or more movable objects (in this description these movable objects are vehicles) A, B, C, ....
  • GPS Global Positioning System
  • other examples of movable objects include, but are not limited to, two-wheeled motor vehicles, trains, marine vessels, aircraft, forklifts, robots, and information terminals such as mobile phones that move with a person.
  • Each GPS satellite orbits the earth and constantly transmits navigation messages.
  • These navigation messages include, for example, information pertaining to the orbit of the GPS satellite, a clock correction value, a correction coefficient for the ionosphere, and a health message and the like.
  • the navigation messages are constantly being transmitted toward Earth, and are dispersed by C/A code and transmitted on a Ll carrier (which is on a frequency of 1575.42 MHz).
  • GPS satellites in operation orbiting the globe at altitudes of approximately 20,000 km.
  • the GPS satellites are arranged evenly in six different orbital planes around the earth, each inclined 55 degrees to the equator, with four GPS satellites in each orbital plane. Therefore, at least five GPS satellites can be observed at any given time anywhere on earth as long as it is an area where the sky is visible.
  • FIG 2 is a view showing an example structure of the relative position detecting apparatus 30.
  • This relative position detecting apparatus 30 includes a GPS receiver 40, a communication device 50, and a control device 60.
  • the GPS receiver 40 is an example of observation data obtaining means of the invention
  • the communication device 50 is an example of communicating means of the invention.
  • the GPS receiver 40 houses an oscillator, not shown, the frequency of which matches the carrier frequency of a GPS satellites 10.
  • the GPS receiver 40 converts the signal received from each GPS satellite (i.e., the satellite signal) by a GPS antenna 42 into an intermediate frequency and then performs C/A code synchronization using a C/A code generated in the GPS receiver 40 to retrieve a navigation message.
  • the GPS receiver 40 measures an integrated value ⁇ k (t) of a carrier phase at time t, as shown in the expression below, based on a carrier from the GPS satellite 10k.
  • the carrier phase integrated value ⁇ k may also be measured for both the Ll wave and a L2 wave (which is on a frequency of 1227.6 MHz).
  • Nk is an integer bias
  • ⁇ k is the travel time from the GPS satellite 10 k to the GPS receiver 40
  • E k is noise (error).
  • ⁇ k (t) ⁇ k (t) - ⁇ k (t - ⁇ k ) + N k + ⁇ k (t) ... (1)
  • the GPS receiver 40 measures a pseudo range pt, as shown in the expression below, based on the C/A code transmitted on each carrier from the GPS satellite 10 k .
  • c is the speed of light
  • b k is the clock bias which corresponds to the range error due to clock error within a GPS receiver 44.
  • p k (t) c ⁇ ⁇ k + b k ...
  • the communication device 50 is a device that communicates with other vehicles.
  • the communication device 50 transmits and receives information to and from other vehicles using a frequency band of 5.8 GHz that is used with DSRC (Dedicated Short Range Communication).
  • DSRC Dedicated Short Range Communication
  • the invention is not limited to this.
  • the communication device 50 may also communicate wirelessly using a beacon or the like, or communicate wirelessly by means of a short range radio communication system such as Bluetooth (registered trademark).
  • the communication device 50 decodes the signals and the like received from the other vehicles and outputs the obtained information to the control device 60.
  • the control device 60 is a microcomputer that is centered around a
  • the control device 60 also includes a storage device such as a HDD (Hard
  • the control device 60 has, as main functional blocks that function by the CPU executing the programs stored in the ROM, a communication control portion 62, a single point positioning calculating portion 64, an interferometric positioning calculating portion 66, and a reliability determining portion 68.
  • the single point positioning calculating portion 64 and the interferometric positioning calculating portion 66 are examples of positioning calculating means of the invention.
  • the communication control portion 62 communicates with the other vehicles and assigns a role of (1) a reference vehicle, (2) a non-reference vehicle (in charge of making a reliability determination), or (3) a non-reference vehicle (not in charge of making the reliability determination) to each of the three of more vehicles including the host vehicle.
  • the specific method by which the roles are assigned is not particularly limited. That is, any one of various methods may be used.
  • the vehicle that initiates a call may be designated as the reference vehicle, and the vehicle that replies first may be designated as the non-reference vehicle (in charge of making the reliability determination), while the vehicle that replies later may be designated as the non-reference vehicle (not in charge of making the reliability determination).
  • the single point positioning calculating portion 64, the interferometric positioning calculating portion 66, and the reliability determining portion 68 either perform processing or do not perform processing depending on the role assumed by the vehicle (i.e., the host vehicle).
  • FIG 3 is a view showing how the processing performed by the vehicles is shared in the relative position detecting system 1.
  • vehicle A will be the reference vehicle
  • vehicle B will be the non-reference vehicle (not in charge of making the reliability determination)
  • vehicle C will be the non-reference vehicle (in charge of making the reliability determination).
  • observation data when necessary
  • the data of the phase integrated value ⁇ k will be referred to as "Ll data” and “L2 data” corresponding to the Ll wave and the L2 wave, respectively.
  • FIG 4 is a sequential diagram showing the flow of the processing performed by the vehicles (i.e., the relative position detecting apparatuses mounted in the vehicles, hereinafter simply omitted) in the relative position detecting system 1.
  • the step numbers in the following description correspond to the step numbers in the drawing.
  • the reference vehicle A transmits the Ll data, the L2 data, and the C/A data of the five satellites, as well as the position XA of the vehicle according to single point positioning calculated by the single point positioning calculating portion 64, together with the receiving time of the signals upon which these calculations are based, to the non-reference vehicles B and C (SlOO and S102).
  • the single point positioning calculating portion 64 then calculates the position of the host vehicle by single point positioning using the pseudo ranges P k to at least four GPS satellites 10 k measured by the GPS receiver 40.
  • a description of the position calculation by single point positioning is well known by those skilled in the art and so will be omitted here. Incidentally, when the position X A of the vehicle using the pseudo ranges p k is to be calculated in the non-reference vehicles B and C, the transmission of the position XA of the vehicle by single point positioning from the reference vehicle A may be omitted.
  • the interferometric positioning calculating portion 66 performs a RTK positioning calculation of one sample of data based on observation data (Ll data and L2 data) of the five satellites measured by the GPS receiver 40 of the non-reference vehicle B in synchronization with the receiving time received from the reference vehicle A, and observation data received from the reference vehicle A, and then calculates a vector XAB > and a double phase difference N Jh AB of an integer bias (S 104).
  • the superscript j and h represent a selected two of the five satellites.
  • the receiving time synchronization is performed using a GPS time or a PSS signal or the like.
  • the interferometric positioning calculating portion 66 similarly performs a RTK positioning calculation of one sample of data based on observation data (Ll data and L2 data) measured by the GPS receiver 40 of the non-reference vehicle C in synchronization with the receiving time received from the reference vehicle A, and observation data received from the reference vehicle A, and then calculates a vector X A c, and a double phase difference of an integer bias (S 106).
  • the RTK positioning calculation is one type of interferometric positioning.
  • the interferometric positioning calculating portion 66 of the non-reference vehicle B calculates the double phase difference N ⁇ AB of the integer bias and the phase position (vector X A B) of the non-reference vehicle B with respect to the reference vehicle A according to the least squares method, with the double phase difference ⁇ A B of the observation data as the observation quantity and the position XB of the non-reference vehicle B and the double phase difference N J1I AB of the integer bias as state variables.
  • the phase integrated value of the L2 wave may be added in the same manner as the phase integrated value of the Ll wave.
  • [X A (t), Y A (t), Z A (t)] in Expression (4) is a coordinate value on a world coordinate system of the reference vehicle A at time t. A value calculated by single point positioning can be used for the reference vehicle A.
  • [XB (t), YB (0, ZB (t)] is a coordinate value (unknown) of the non-reference vehicle B at time 1
  • [Xj (t), Yj (t), Z j (t)] and [X h (t), Y h (t), Z h (t)] are coordinate values of the GPS satellites 10 j and 1Oh, respectively, at time t.
  • N JH AB is a double phase difference of the integer bias and satisfies Expression (5) below.
  • N jh AB (N j A - N J B) - (N h A - N h B ) ... (5)
  • V is the observation noise
  • [XB, YB, Z B , N 12 AB, N 13 AB, N 14 A 3 , N 15 AB ] T (where ⁇ indicates transposition).
  • the observation quantity Z in Expression (8) is the double phase difference ⁇ AB of the phase integrated value and the double phase difference O ⁇ AB of the pseudo range.
  • the observation equation of Expression (8) is linear, but the observation quantity Z in Expressions (4) and (7) is nonlinear regarding the state variables XB, Y B , and Z B - Therefore, the terms in Expressions (4) and (7) are each partially differentiated by the state variables XB, Y B , and Z B to obtain the observation matrix H in Expression (8) above.
  • the observation matrix H is as shown below.
  • the observation matrix H incorporates both of these two observation matrixes H 1 and H 2 .
  • the interferometric positioning calculating portion 66 obtains the integer root (i.e., the wave number) with the smallest error with respect to the calculated real root, for example, as a first candidate, and then obtains the integer solution with the next smallest error as the second candidate.
  • the LAMBDA method which solves a problem by decorrelating the integer bias and narrowing the search domain of the integer solution, may also be used for this method.
  • an integer solution may be derived by the least squares method of another integer or by rounding off.
  • the coordinate XB of the non-reference vehicle B in which the coordinate of the reference vehicle A is a known value can be obtained, so the vector X A B can be obtained. Also, the double phase difference N ⁇ A B of the integer bias can be obtained.
  • the RTK positioning calculation is performed using one sample of data, so it is expected that the processing will be easy and quick compared to when a RTK positioning calculation is performed in time series using a Kalman filter or the like.
  • the non-reference vehicle B calculates the vector X AB and the double phase difference N ⁇ AB of the integer bias
  • the non-reference vehicle C calculates the vector X A c and the double phase difference N* h A c of the integer bias
  • the reliability determining portion 68 in the non-reference vehicle C determines the reliability (i.e., makes a reliability determination) (SIlO). This reliability determination is made based on whether Expression (11) below is satisfied. If Expression (11) is satisfied, the reliability of the calculated double phase difference of the integer bias is high so it can be determined that the reliability of the calculated relative positions among vehicles A, B, and C is high.
  • is the wavelength (approximately 20 [cm]) of the carrier
  • is a predetermined value set in advance to a value equal to or less than 2 / ⁇ (such as approximately 5 to 10 [cm]).
  • f (x B , xc) is expressed by Expression (12).
  • the coordinate XB of the non-reference vehicle B is obtained by adding the vector X A B to the coordinate X A of the reference vehicle A.
  • the coordinate Xc of the non-reference vehicle C is obtained by adding the vector XA C to the coordinate x A of the reference vehicle A.
  • the non-reference vehicle C then transmits the results of the reliability determination to the reference vehicle A and the non-reference vehicle B (S 112 and S 114). If the determination results obtained by the non-reference vehicle C indicate high reliability, the integer solution is fixed in the vehicles (S116, S118, and S120), and then the relative positions among the vehicles are calculated by RTK positioning calculations using that integer solution. If, on the other hand, the determination results obtained by the non-reference vehicle C indicate low reliability, the integer solution is not fixed in the vehicles. Instead, interim measures are taken, e.g., the relative positions are tentatively calculated using the last obtained integer solution.
  • the reliability of the integer bias can be efficiently determined when three or more vehicles detect their relative positions by the RTK positioning calculation.
  • the data transmitted from the non-reference vehicle B to the non-reference vehicle C is the vector XAB, the double phase difference N jh AB of the integer bias of two (i.e., a pair of) satellites, and a single phase difference ⁇ B of the phase integrated value related to the same pair of satellites.
  • the position of either one of the vehicles according to single point positioning must be transmitted when necessary, in addition to the phase integrated values of at least five satellites.
  • the processing load of the RTK positioning calculation itself is relatively large.
  • the communication and processing loads can be reduced compared to what they are when determining the reliability by performing RTK positioning calculations between vehicles A and B, between vehicles A and C, and between vehicles B and C, and then performing a ratio test or the like. Also, there is no bothersome processing that is otherwise required when there is a discrepancy between the results from performing the RTK positioning calculations between vehicles A and B, between vehicles A and C, and between vehicles B and C. [0066] Accordingly, the relative position detecting system 1 and the relative position detecting apparatus 30 that makes up this relative position detecting system 1 in this example embodiment are able to obtain the relative positions among three or more movable objects by interferometric positioning, and efficiently determine the reliability of the interferometric positioning.
  • the control device 60 has the communication control portion 62, the single point positioning calculating portion 64, the interferometric positioning calculating portion 66, and the reliability determining portion 68. [0069] In a predetermined situation in which communication is possible with two or more other vehicles, the communication control portion 62 communicates with the other vehicles and assigns a role of (1) a reference vehicle or (2) a non-reference vehicle to the three of more vehicles including the host vehicle.
  • the single point positioning calculating portion 64 and the interferometric positioning calculating portion 66 have the same functions as they do in the first example embodiment. That is, the single point positioning calculating portion 64 calculates the position of the host vehicle by single point positioning, and the interferometric positioning calculating portion 66 calculates the relative position of the host vehicle with respect to the reference vehicle and the double phase difference of the integer bias regarding the relationship with the reference vehicle when the host vehicle is a non-reference vehicle.
  • the non-reference vehicle performs a RTK positioning calculation using i) the received data, i.e., the Ll data, the L2 data, and the C/A data of the five satellites, and the position of the vehicle according to single point positioning calculated by the single point positioning calculating portion 64, which aTe all transmitted from the reference vehicle to the non-reference vehicle, and ii) the observation data observed by the non-reference vehicle, and calculates its relative position (vector) with respect to the reference vehicle and the double phase difference of the integer bias regarding the relationship with the reference vehicle. Then the non-reference vehicle performs a ratio test or the like to determine the reliability of the RTK positioning calculation.
  • FIG 5 is a flowchart illustrating the flow of the process executed by the control apparatuses 60 (mainly the reliability determining portions 68) of the non-reference vehicles after performing the RTK positioning calculation.
  • the control apparatuses 60 mainly the reliability determining portions 68
  • the reliability determining portion 68 performs a ratio test (S200) on the integer bias N ⁇ AB calculated by the interferometric positioning calculating portion 66.
  • the ratio test is performed as described below. For example, a case will be assumed in which there are four pairs (j, h) of paired GPS satellites 10, e.g., (1, 2), (1, 3), (1, 4), and (1, 5), and the real roots of four integer biases (n 12 , n 13 , n 14 , and n 15 ) and the first candidates N 13 U N 14 J , and N 15 O and second candidates (N 12 2 , N u 2 , N 14 2 , and N 15 2 ) of integer solutions of the integer biases are calculated.
  • the ratio R is a ratio of i) the range (norm) between the real root of the integer bias and the first candidate of the integer solution of the integer bias to ii) the range between the real root of the integer bias and the second candidate of the integer solution of the integer bias, as shown below.
  • the ratio R is typically indicates that the reliability of the first candidate of the integer solution of the integer bias increases as the value increases.
  • the reliability is determined to be high. If the ratio R is equal to or greater than the predetermined value ⁇ i (e.g., a value of approximately 3), the reliability is determined to be high. If the ratio R is equal to or greater than the predetermined value ⁇ 2 (e.g., approximately 1.5) but less than the predetermined value ⁇ i, the reliability is determined to be medium. If the ratio R is less than the predetermined value ⁇ 2 , the reliability is determined to be low.
  • the predetermined value ⁇ i e.g., a value of approximately 3
  • a signal indicating such is transmitted to the other non-reference vehicle C (S204). If a signal indicating that the reliability as determined by the non-reference vehicle C is high is also received from the non-reference vehicle C, it is determined that the integer solutions of the integer biases calculated by the non-reference vehicles B and C this time are correct and those integer solutions are fixed in the vehicles. Then the relative positions among the vehicles are calculated by RTK positioning calculations using those integer solutions (S206 and S208).
  • the reliability is medium
  • the observation data of the non-reference vehicle C is requested and obtained (S210).
  • the interferometric positioning calculating portion 66 is instructed to perform a RTK positioning calculation for the relationship between the Host vehicle and the reference vehicle C (S212).
  • step S202 If it is determined in step S202 that the reliability is low, and it is determined in step S214 that the double phase difference of the integer bias does not match, the satellite responsible for lowering the ratio R is identified (S216). More specifically, ratio tests are performed sequentially omitting one of the pairs (1, 2), (1, 3),
  • the reliability is determined by comparing the ratio R calculated by the ratio test performed with the identified satellite omitted with the predetermined values ⁇ x and ⁇ 2 (S218). If the reliability here is high, the reliability is regarded as being high and a signal indicative of such is transmitted to the other non-reference vehicle C (S204).
  • step S218 If in step S218 the reliability is medium or low, it is determined whether the inequality expression of Expression (11) described in the first example embodiment is satisfied (S220) using the phase integrated value ⁇ H B C calculated according to the observation data obtained in step S212 (i.e., by requesting and obtaining the observation data of the non-reference vehicle C when step S212 is not performed).
  • the observation data for the satellite for which the radio signal was not observed with the reference vehicle A may be reflected in the phase integrated value ⁇ BC-
  • Expression (11) is calculated by selecting two satellites so any pair of satellites, except for the satellite that was identified in step S216, is selected. If the inequality expression in Expression (11) is satisfied, the reliability is regarded as being high so a signal indicating such is transmitted to the other non-reference vehicle C (S204).
  • step S220 If the determination in step S220 is No, it is determined that the currently calculated integer bias is unreliable so the signal indicating that the reliability is high is not transmitted from the non-reference vehicle B to the non-reference vehicle C (S222). That is, the integer solution of the integer bias is not fixed. In this case, interim measures are taken such as continuing to use the previously calculated integer bias.
  • the real root of the integer bias is obtained by an instantaneous positioning method.
  • a method other than that described above may be used.
  • a method may also be used which uses only the double phase difference of the phase integral value and does not use the double phase difference of the pseudo range.
  • the GPS receiver is a two frequency receiver capable of receiving both Ll and L2 waves (L2 being on a frequency of 1227.6 MHz) transmitted from a GPS satellite
  • the double phase difference of the phase integrated value for the L2 wave may be used additionally or alternatively as the observation quantity Z.
  • the double phase difference of a phase integrated value for a carrier of another band (such as the radio waves of an L5 band planned to be added in the future) may be used additionally or alternatively as the observation quantity Z.
  • a single or double phase difference of a pseudo range based on a similar PRN code (pseudorandom noise code) other than a C/A code (such as a P code) may be used additionally or alternatively as the observation quantity Z.
  • Mt may request and obtain the observation data of the non-reference vehicle B, perform interferometric positioning regarding the relationship between the non-reference vehicle B and the host vehicle, and determine whether the calculated double phase difference N jh B c of the integer bias matches the difference between N JH A B and N jh A c > just as in steps S212 and 214 in the second example embodiment. If it matches, the reliability may be regarded as being high.
  • the invention is applied to GPS.
  • the invention may also be applied to a satellite system other than GPS, such as another GNSS (Global Navigation Satellite System) such as Galileo, for example.
  • GNSS Global Navigation Satellite System
  • Galileo Global Navigation Satellite System
  • the invention may be used in automotive manufacturing and automotive parts manufacturing and the like.

Abstract

In a case in which three or more movable objects (A, B, C), each of those detecting the relative position with respect to another movable object, are able to communicate with each other: a reference (A) movable object obtains observation data and transmits the observation data to non-reference movable objects; one non-reference movable object (B) calculates the relative position with respect to the reference movable object by performing interferometric positioning using the observation data obtained by the observation data obtaining means and data including observation data received from the reference movable object, and also transmits data including an integer bias calculated as interferometric positioning results to another non-reference movable object (C) and receives reliability determination results regarding the interferometric positioning; and the another non-reference movable object receives data including the integer bias from the one non-reference movable object and determines the reliability of the interferometric positioning. In a second configuration a non-reference movable object determines its relative position with respect to a reference movable object. It then determines via a ratio test the reliability of this position solution for identifying and omitting a satellite signal that is responsible for lowering the reliability.

Description

RELATIVE POSITION DETECTING APPARATUS, AND RELATIVE POSITION
DETECTING SYSTEM
BACKGROUND OF THE INVENTION
1. Field of the Invention
[0001] The invention relates to a relative position detecting apparatus which is mounted in a movable object and detects the relative position of that movable object with respect to another moving object, as well as to a relative position detecting system made up of three or more movable objects each of which is provided with the relative position detecting apparatus.
2. Description of the Related Art
[0002] As related art, apparatuses that observe for satellite signals, obtain the observed data, and calculate the position of a movable object by performing a positioning calculation are used in vehicle navigation systems, marine vessels, and mobile phones and the like.
[0003] The main method of calculating the position is referred to as single point positioning. Single point positioning is a method which calculates pseudo ranges to a plurality of satellites based on the observed data obtained at a single observation point, and then calculates the position of the observation point according to the principle of triangulation.
[0004] However, a known method referred to as interferometric positioning that enables the position to be more precisely calculated is also being put into practical use. Interferometric positioning is a method which calculates the position of a measure point by obtaining a base vector from a known point to the measure point based on the observed data obtained at the observation point. Interferometric positioning uses a carrier phase with a short cycle compared to a C/A code that is normally used in single point positioning. Therefore, the frequency (i.e., the integer bias) from the satellite to the observation point must be specified. [0005] Japanese Patent Application Publication No. 2003-270319 (JP-A-2003-270319), for example, describes an invention relating to this interferometric positioning. More specifically, JP-A-2003-270319 describes a method for calculating satellite positioning that involves the following steps. That is, for a satellite signal from the same satellite from which signals are received at a position on a reference side and a position on a positioning side (i.e., a measuring side), a relational expression between i) a carrier phase difference, ii) a carrier phase bias of an integer included in the carrier phase difference, iii) a phase difference between the positioning side and the reference side related to a reference phase by observation of the carrier phase, iv) the position of the satellite sending the satellite signal received by the reference side and the positioning side, and v) the positions of the reference side and the positioning side, is obtained. When relational expressions obtained at a plurality of observation timings are simultaneously satisfied, a conditional expression that defines the difference in the reference phase and the position on the positioning side is obtained and the condition obtained by this conditional expression is then substituted into the relational expression, such that an expression in which the variables corresponding to the difference in the reference phase and the position on the positioning side have been eliminated is obtained. Then the integer bias is obtained from the conditions that are satisfied with only a slight difference for this expression with no variables. [0006] This method described in JP-A-2003-270319 is a method for calculating the integer bias between two points. However, when it is applied to a case in which three or more movable objects measure their relative positions, various problems arise. For example, when each of three or more movable objects measures its relative position with respect to the other movable objects, the communication and calculation loads increase. As a result, it may no longer possible to coordinate the positional relationships among the plurality of movable objects.
SUMMARY OF THE INVENTION [0007] This invention thus provides a relative position detecting apparatus and a relative position detecting system capable of obtaining the relative positions of three or more movable objects using interferometric positioning, as well as efficiently determining the reliability of that interferometric positioning. [0008] A first aspect of the invention relates to a relative position detecting apparatus which is mounted in one movable object and detects the relative position of the one movable object with respect to another movable object. This relative position detecting apparatus includes observation data obtaining means for obtaining observation data by observing a satellite signal, communicating means for communicating with the other movable object, positioning calculating means for performing a positioning calculation using the observation data obtained by the observation data obtaining means, and observation data received from the other movable object by the communicating means, and reliability determining means for determining the reliability of the results of the positioning calculation performed by the positioning calculating means. In a predetermined case in which three or more movable objects including the one movable object, one of the three or more movable objects being a reference movable object and the other two or more of the three or more movable objects being non-reference movable objects one of which is a first non-reference movable object and the other one or more of which is a second non-reference movable object, are able to communicate with each other: when the one movable object is the reference movable object, the communicating means transmits data that includes the observation data obtained by the observation data obtaining means to the other movable objects; when the one movable object is the second non-reference movable object, the positioning calculating means calculates the relative position of the one movable object with respect to the reference movable object by performing interferometric positioning that uses the obtained observation data and data that includes observation data received from the reference movable object, and the communicating means transmits data that includes an integer bias calculated in the interferometric positioning to the first non-reference movable objects, and receives the results from determining the reliability of the iπterferometric positioning based on the transmitted data that includes the integer bias from the first non-reference movable object; and when the one movable object is the first non-reference movable object, the positioning- calculating means calculates the relative position of the one movable object with respect to the reference movable object by performing interferometric positioning using the obtained observation data and the data that includes observation data received from the reference movable object; the communicating means receives data that includes the integer bias from the second non-reference movable object; and the reliability determining means determines the reliability of the interferometric positioning based on the received data that includes the integer bias.
[0009] According to this structure, the relative positions among three or more movable objects can be obtained by interferometric positioning, and the reliability of the interferometric positioning can be efficiently determined.
[0010] In the relative position detecting apparatus according to the first aspect, it may be determined whether the one movable object is the reference movable object based on communication with the other movable objects.
[0011] Also, in the relative position detecting apparatus according to the first aspect, when the one movable object is one of the non-reference movable objects, it may be determined whether the one movable object is the first non-reference movable object or the second non-reference movable object based on communication with the other one or more non-reference movable objects.
[0012] A second aspect of the invention relates to a relative position detecting apparatus which is mounted in one movable object and detects the relative position of the one movable object with respect to another movable object. This relative position detecting apparatus includes observation data obtaining means for obtaining observation data by observing a satellite signal, communicating means for communicating with the other movable object, positioning calculating means for performing a positioning calculation using the observation data obtained by the observation data obtaining means, and observation data received from the other movable object by the communicating means, and reliability determining means for determining the reliability of the results of the positioning calculation performed by the positioning calculating means. In a predetermined case in which three or more movable objects, including the one movable object, one of the three or more movable objects being a reference movable object and the other two or more of the three or more movable objects being non-reference movable objects one of which is a first non-reference movable object and the other one or more of which is a second non-reference movable object, are able to communicate with each other and the one movable object is the reference movable object, the communicating means transmits data that includes the observation data obtained by the observation data obtaining means to the other movable objects. Also, in a predetermined case in which three or more movable objects including the one movable object, one of the three or more movable objects being a reference movable object and the other two or more of the three or more movable objects being non-reference movable objects one of which is a first non-reference movable object and the other one or more of which is a second non-reference movable object, are able to communicate with each other: when the one movable object is the reference movable object, the communicating means transmits data that includes the observation data obtained by the observation data obtaining means to the other movable objects; and when the one movable object is the second non-reference movable object, the positioning calculating means calculates the relative position of the one movable object with respect to the reference movable object by performing interferometric positioning using the obtained observation data and the data that includes observation data received from the reference movable object, and the reliability determining means performs a ratio test on the interferometric positioning, and if a ratio value of the performed ratio test is equal to or less than a predetermined value, the reliability determining means identifies the satellite signal related to the observation data responsible for lowering the ratio value and performs the ratio test again omitting the identified satellite signal.
[0013] According to this structure, if the reliability is unable to be confirmed by a ratio test, another ratio test is performed omitting the satellite responsible for lowering the ratio, so the reliability of the interferometric positioning can be improved.
[0014] In the relative position determining apparatus according to the second aspect, it may be determined whether the one movable object is the reference movable object based on communication with the other movable objects. [0015] Also, in the relative position determining apparatus according to the second aspect, if the ratio value obtained is equal to or less than the predetermined value when the ratio test is performed again by the non-reference movable object that performed the ratio test again, the communicating means may transmit and receive observation data to and from the other one or more non-reference movable objects, and the reliability determining means may determine the reliability based on a comparison of i) the results of interferometric positioning regarding the relationship between the one movable object and the reference movable object, and ii) the results of the interferometric positioning regarding the relationship between the one movable object and the other one or more non-reference movable objects performed by the positioning calculating means or the results of the interferometric positioning performed by the other one or more non-reference movable objects. Alternatively, the communicating means may receive reliability determination results from one of the other one or more non-reference movable objects.
[0016] With this structure, it may be determined, based on communication with the other one or more non-reference movable objects, whether the results that are to be compared with the results of interferometric positioning regarding the relationship between the one movable object and the reference movable object are the results of interferometric positioning regarding the relationship between the one movable object and the other one or more non-reference movable objects or the results of interferometric positioning performed by the other one or more non-reference movable objects. Furthermore, the interferometric positioning regarding the relationship between the one movable object and the other one or more non-reference movable objects may use observation data of a satellite signal not used in the interferometric positioning regarding the relationship between the one movable objecf and the reference movable object. [0017] A third aspect of the invention relates to a relative position detecting system that includes three or more movable objects each of which is provided with observation data obtaining means for obtaining observation data by observing a satellite signal, communicating means for communicating with the other movable objects, and positioning calculating means for performing a positioning calculation using the observation data obtained by the observation data obtaining means and observation data received from the other movable objects by the communicating means. In a predetermined case in which the three or more movable objects, one of the three or more movable objects being a reference movable object and the other two or more of the three or more movable objects being non-reference movable objects one of which is a first non-reference movable object and the other one or more of which is a second non-reference movable object, are able to communicate with each other: the reference movable object transmits data that includes the observation data obtained by the observation data obtaining means to the other movable objects; the positioning calculating means of the non-reference movable objects calculate the relative positions of the non-reference movable objects with respect to the reference movable object by performing interferometric positioning using the obtained observation data and data that includes observation data received from the reference movable object; the second non-reference movable object transmits data that includes an integer bias calculated in the interferometric positioning to the first non-reference movable objects and receives the results from determining the reliability of the interferometric positioning based on the transmitted data that includes the integer bias from the first non-reference movable object; and the first non-reference movable object receives the data that includes the integer bias from the second non-reference movable object, and determines the reliability of the interferometric positioning based on the received data that includes the integer bias.
[0018] According to this structure, the relative positions among three or more movable objects can be obtained by interferometric positioning, and the reliability of the interferometric positioning can be efficiently determined. [0019] In the relative position detecting system according to this aspect, one of the movable objects may be determined to be the reference movable object and the other movable objects may be determined to be the non-reference movable objects by the three or more movable objects that make up the relative position detecting system communicating with each another.
[0020] Also, in the relative position detecting system according to this aspect, it may be determined, for each of the non-reference movable objects, whether the non-reference movable object is the first non-reference movable object or the second non-reference movable object by the non-reference movable objects communicating with each other.
[0021] A fourth aspect of the invention relates to a relative position detecting system that includes three or more movable objects each of which is provided with observation data obtaining means for obtaining observation data by observing a satellite signal, communicating means for communicating with the other movable objects, and positioning calculating means for performing a positioning calculation using the observation data obtained by the observation data obtaining means and observation data received from the other movable objects by the communicating means. In a predetermined case in which the three or more movable objects, one of the three or more movable objects being a reference movable object and the other two or more of the three or more movable objects being non-reference movable objects one of which is a first non-reference movable object and the other one or more of which is a second non-reference movable object, are able to communicate with each other: the reference movable object transmits data that includes the observation data obtained by the observation data obtaining means to the other movable objects; and one of the non-reference movable objects uses the positioning calculating means to calculate the relative position of the non-reference movable object with respect to the reference movable object by performing interferometric positioning using the obtained observation data and data that includes the observation data received from the reference movable object, and performs a ratio test on the interferometric positioning, and if the ratio value of the performed ratio test is equal to or less than a predetermined value, identifies the satellite signal related to the observation data responsible for lowering the ratio value and performs the ratio test again omitting the identified satellite signal.
[0022] According to this structure, if the reliability is unable to be confirmed by a ratio test, another ratio test is performed omitting the satellite responsible for lowering the ratio, so the reliability of the interferometric positioning can be improved.
[0023] In the relative position detecting system according to this aspect, one of the movable objects may be determined to be the reference movable object and the other movable objects may be determined to be the non-reference movable objects by the three or more movable objects that make up the relative position detecting system communicating with each another.
[0024] Also, in the relative position detecting system according to this aspect, if the ratio value obtained is equal to or less than the predetermined value when the ratio test is performed again by the non-reference movable object that performed the ratio test again, the non-reference movable object may transmit and receive observation data to and from the other one or more non-reference movable objects, perform interferometric positioning regarding the relationship with the other one or more non-reference movable objects, and make a reliability determination based on a comparison of i) the results of interferometric positioning regarding the relationship with the reference movable object, and ii) the results of the performed interferometric positioning or the results of the interferometric positioning performed by the other one or more non-reference movable objects, or receive reliability determination results from the one of the other one or more non-reference movable objects.
[0025] With this structure, the non-reference movable objects may communicate with each other and each non-reference movable object may determine whether to perform interferometric positioning regarding the relationship with the other one or more non-reference movable objects or have one of the other one or more non-reference movable objects perform interferometric positioning. Further, observation data of a satellite signal not used in the interferometric positioning regarding the relationship with the reference movable object may be used in the interferometric positioning regarding the relationship with the other one or more non-reference movable objects.
[0026] This invention makes it possible to provide a relative position detecting apparatus and a relative position detecting system capable of obtaining the relative positions of three or more movable objects using interferometric positioning, as well as efficiently determining the reliability of that interferometric positioning.
BRIEF DESCRIPTION OF THE DRAWINGS
[0027] The foregoing and further objects, features and advantages of the invention will become apparent from the following description of example embodiments with reference to the accompanying drawings, wherein like numerals are used to represent like elements and wherein: FIG 1 is a view showing a frame format of the system structure of a relative position detecting system according to a first example embodiment of the invention;
FIG 2 is a view showing an example structure of a relative position detecting apparatus according to the first example embodiment of the invention;
FIG 3 is a view showing how processing performed by vehicles is shared in the relative position detecting system according to the first example embodiment of the invention;
FIG 4 is a sequential diagram showing the flow of processing performed by the vehicles in the relative position detecting system according to the first example embodiment of the invention; and FIG 5 is a flowchart illustrating the flow of a process executed by a control apparatus (mainly a reliability determining portion) of a non-reference vehicle according to a second example embodiment of the invention, which is executed after performing a RTK positioning calculation. DETAILED DESCRIPTION OF EMBODIMENTS
[0028] Example embodiments of the present invention will be described in greater detail below with reference to the accompanying drawings. [0029] Hereinafter, a relative position detecting system 1 according to a first example embodiment of the invention will be described. FIG. 1 is a view showing a frame formaf of the system structure of the relative position detecting system 1. This relative position detecting system 1 is formed by a relative position detecting apparatus 30A, 3OB, 30C, ... being mounted in each of three or more movable objects (in this description these movable objects are vehicles) A, B, C, .... Each vehicle detects its relative position among the vehicles by receiving a satellite signal sent from a plurality of GPS (Global Positioning System) satellites 10k (k = 1, 2, ...) and performing a positioning calculation. Incidentally, other examples of movable objects include, but are not limited to, two-wheeled motor vehicles, trains, marine vessels, aircraft, forklifts, robots, and information terminals such as mobile phones that move with a person.
[0030] Each GPS satellite orbits the earth and constantly transmits navigation messages. These navigation messages include, for example, information pertaining to the orbit of the GPS satellite, a clock correction value, a correction coefficient for the ionosphere, and a health message and the like. The navigation messages are constantly being transmitted toward Earth, and are dispersed by C/A code and transmitted on a Ll carrier (which is on a frequency of 1575.42 MHz).
[0031] Incidentally, there are currently 24 GPS satellites in operation orbiting the globe at altitudes of approximately 20,000 km. The GPS satellites are arranged evenly in six different orbital planes around the earth, each inclined 55 degrees to the equator, with four GPS satellites in each orbital plane. Therefore, at least five GPS satellites can be observed at any given time anywhere on earth as long as it is an area where the sky is visible.
[0032] Each vehicle is provided with a relative position detecting apparatus 30 (the reference characters A, B, C, ... for distinguishing the vehicles are omitted here). FIG 2 is a view showing an example structure of the relative position detecting apparatus 30. This relative position detecting apparatus 30 includes a GPS receiver 40, a communication device 50, and a control device 60. Here, the GPS receiver 40 is an example of observation data obtaining means of the invention, and the communication device 50 is an example of communicating means of the invention.
[0033] The GPS receiver 40 houses an oscillator, not shown, the frequency of which matches the carrier frequency of a GPS satellites 10. The GPS receiver 40 converts the signal received from each GPS satellite (i.e., the satellite signal) by a GPS antenna 42 into an intermediate frequency and then performs C/A code synchronization using a C/A code generated in the GPS receiver 40 to retrieve a navigation message.
[0034] The GPS receiver 40 measures an integrated value Φk (t) of a carrier phase at time t, as shown in the expression below, based on a carrier from the GPS satellite 10k. The carrier phase integrated value Φk may also be measured for both the Ll wave and a L2 wave (which is on a frequency of 1227.6 MHz). In the expression, Nk is an integer bias, τk is the travel time from the GPS satellite 10k to the GPS receiver 40, and Ek is noise (error). Φk (t) = Θk (t) - θk (t - τk) + Nk + εk (t) ... (1)
[0035] Also, the GPS receiver 40 measures a pseudo range pt, as shown in the expression below, based on the C/A code transmitted on each carrier from the GPS satellite 10k. In the expression, c is the speed of light and bk is the clock bias which corresponds to the range error due to clock error within a GPS receiver 44. pk (t) = c χ τk + bk ... (2)
[0036] The communication device 50 is a device that communicates with other vehicles. For example, the communication device 50 transmits and receives information to and from other vehicles using a frequency band of 5.8 GHz that is used with DSRC (Dedicated Short Range Communication). However, the invention is not limited to this. For example, the communication device 50 may also communicate wirelessly using a beacon or the like, or communicate wirelessly by means of a short range radio communication system such as Bluetooth (registered trademark). The communication device 50 decodes the signals and the like received from the other vehicles and outputs the obtained information to the control device 60.
[0037] The control device 60 is a microcomputer that is centered around a
CPU (central processing unit), and in which the CPU, ROM (Read-Only Memory), and RAM (Random Access Memory) and the like are bilaterally connected together via a bus, for example. The control device 60 also includes a storage device such as a HDD (Hard
Disc Drive) or DVD (Digital Versatile Disk) drive, a CD (Compact Disc) drive, or flash memory, as well as I/O ports, a timer, and a counter, and the like. Data as well as programs to be executed by the CPU are stored in the ROM. Also, the control device 60 has, as main functional blocks that function by the CPU executing the programs stored in the ROM, a communication control portion 62, a single point positioning calculating portion 64, an interferometric positioning calculating portion 66, and a reliability determining portion 68. Here, the single point positioning calculating portion 64 and the interferometric positioning calculating portion 66 are examples of positioning calculating means of the invention.
[0038] Incidentally, these functional blocks do not have to be clearly based on different programs. Portions that realize a plurality of functional blocks may be included in the same program. Also, all of some of the functions of the control device 60 may also integrated into the GPS receiver 40 or the communication device 50. [0039] In a predetermined situation in which communication is possible with two or more other vehicles, the communication control portion 62 communicates with the other vehicles and assigns a role of (1) a reference vehicle, (2) a non-reference vehicle (in charge of making a reliability determination), or (3) a non-reference vehicle (not in charge of making the reliability determination) to each of the three of more vehicles including the host vehicle. Only one vehicle assumes the role of the reference vehicle and only one vehicle assumes the role of the non-reference vehicle (in charge of making the reliability determination). The specific method by which the roles are assigned is not particularly limited. That is, any one of various methods may be used. For example, the vehicle that initiates a call may be designated as the reference vehicle, and the vehicle that replies first may be designated as the non-reference vehicle (in charge of making the reliability determination), while the vehicle that replies later may be designated as the non-reference vehicle (not in charge of making the reliability determination). [0040] The single point positioning calculating portion 64, the interferometric positioning calculating portion 66, and the reliability determining portion 68 either perform processing or do not perform processing depending on the role assumed by the vehicle (i.e., the host vehicle). Therefore, the processing of each functional block will be described in view of the role of each vehicle. [0041] FIG 3 is a view showing how the processing performed by the vehicles is shared in the relative position detecting system 1. In the following description, vehicle A will be the reference vehicle, vehicle B will be the non-reference vehicle (not in charge of making the reliability determination), and vehicle C will be the non-reference vehicle (in charge of making the reliability determination). Also, the data of the pseudo range p* and the phase integrated value Φt measured by the GPS receiver 40 will be collectively referred to as "observation data" when necessary, and the data of the phase integrated value Φk will be referred to as "Ll data" and "L2 data" corresponding to the Ll wave and the L2 wave, respectively. Also, the data of the pseudo range pk will be referred to as "C/Adata". [0042] Also, FIG 4 is a sequential diagram showing the flow of the processing performed by the vehicles (i.e., the relative position detecting apparatuses mounted in the vehicles, hereinafter simply omitted) in the relative position detecting system 1. The step numbers in the following description correspond to the step numbers in the drawing.
[0043] The reference vehicle A transmits the Ll data, the L2 data, and the C/A data of the five satellites, as well as the position XA of the vehicle according to single point positioning calculated by the single point positioning calculating portion 64, together with the receiving time of the signals upon which these calculations are based, to the non-reference vehicles B and C (SlOO and S102). The single point positioning calculating portion 64 then calculates the position of the host vehicle by single point positioning using the pseudo ranges Pk to at least four GPS satellites 10k measured by the GPS receiver 40. A description of the position calculation by single point positioning is well known by those skilled in the art and so will be omitted here. Incidentally, when the position XA of the vehicle using the pseudo ranges pk is to be calculated in the non-reference vehicles B and C, the transmission of the position XA of the vehicle by single point positioning from the reference vehicle A may be omitted.
[0044] In the non-reference vehicle B, the interferometric positioning calculating portion 66 performs a RTK positioning calculation of one sample of data based on observation data (Ll data and L2 data) of the five satellites measured by the GPS receiver 40 of the non-reference vehicle B in synchronization with the receiving time received from the reference vehicle A, and observation data received from the reference vehicle A, and then calculates a vector XAB> and a double phase difference NJh AB of an integer bias (S 104). Incidentally, the superscript j and h represent a selected two of the five satellites. The receiving time synchronization is performed using a GPS time or a PSS signal or the like.
[0045] In the non-reference vehicle C as well, the interferometric positioning calculating portion 66 similarly performs a RTK positioning calculation of one sample of data based on observation data (Ll data and L2 data) measured by the GPS receiver 40 of the non-reference vehicle C in synchronization with the receiving time received from the reference vehicle A, and observation data received from the reference vehicle A, and then calculates a vector XAc, and a double phase difference
Figure imgf000016_0001
of an integer bias (S 106). . The RTK positioning calculation is one type of interferometric positioning.
[0046] Here, an overview of the RTK positioning calculations performed in the non-reference vehicles B and C will be given, but to simplify the description, only the calculation performed in the non-reference vehicle B will be described.
[0047] The interferometric positioning calculating portion 66 of the non-reference vehicle B calculates the double phase difference N^AB of the integer bias and the phase position (vector XAB) of the non-reference vehicle B with respect to the reference vehicle A according to the least squares method, with the double phase difference Φ^AB of the observation data as the observation quantity and the position XB of the non-reference vehicle B and the double phase difference NJ1I AB of the integer bias as state variables. Hereinafter, to simplify the description, a case in which only the Ll data is used will be described. However, when the L2 data is used, the phase integrated value of the L2 wave may be added in the same manner as the phase integrated value of the Ll wave.
[0048] First, the double phase difference of the phase integrated value relating to two paired GPS satellites 1Oj and 1Oh (j * h) and the vehicles A and B at a given time t are obtained according to Expression (3) below. Φ*AB = (φiA (t) - ^B (0) - (Φh A (t) - Φhβ (t)) ... (3)
[0049] The double phase difference Φ^AB of the phase integrated value here becomes as follows due to the physical implications of (distance between the GPS satellite and the GPS receiver) = (wavelength L of the carrier) x (phase integrated value).
Figure imgf000017_0001
-U{xΛ{t)-xh{f)γ HYΛ{t)-Yh(t)γ +(Z Λt)-zh(t)ϊ
Figure imgf000017_0002
[0050] Here, [XA (t), YA (t), ZA (t)] in Expression (4) is a coordinate value on a world coordinate system of the reference vehicle A at time t. A value calculated by single point positioning can be used for the reference vehicle A. Also, [XB (t), YB (0, ZB (t)] is a coordinate value (unknown) of the non-reference vehicle B at time 1, and [Xj (t), Yj (t), Zj (t)] and [Xh (t), Yh (t), Zh (t)] are coordinate values of the GPS satellites 10j and 1Oh, respectively, at time t. Also, NJHAB is a double phase difference of the integer bias and satisfies Expression (5) below. NjhAB = (Nj A - NJB) - (Nh A - Nh B) ... (5)
[0051] Also, the double phase difference of the pseudo range related to the GPS satellites 1Oj and 1Oh 0 h) at ^me * >s obtained according to Expression (6) below.
/AS = (PjA (0 - PjB (0) - (PhA (0 - PhB (Q) .- (6) [0052] The double phase difference O^AB of the pseudo range can also be expressed as shown in Expression (7) below.
P% = U(X AO-Xj(O)2 HYA(O- YJO)Y HZAO-Zj(O)2 -^XAO-XJ(O)2 HYB(O-YJ(OY HZ8(O-ZJ(O) -^(XAO- XΛ0Ϋ HYA0-YΛ0Ϋ HZA0-zh(0Ϋ
Figure imgf000018_0001
[0053] The terms [XA (t), YA (t), ZA (Q], [XB (t), YB (Q, Z3 (Q], [Xj (t), Yj (Q, Z, (Q], and [Xh (t), Yh (Q, Zh (Q] in Expression (7) are the same as they are in Expression (4).
[0054] Then the relationship between the observation quantity Z (i) and the state variable η (i) can be expressed by the linear model shown below. Z(i) = H (i) x η (i) + V (i) ... (8)
[0055] Here, V is the observation noise, and η (i) represents the state variable of the observation cycle i (= 1, 2, ...) and is a double phase difference of the integer bias and the coordinate value (unknown) of the non-reference vehicle B. For example, when there are four pairs (j, h) of paired GPS satellites 10, e.g., (1, 2), (1, 3), (1, 4), and (1, 5), η = [XB, YB, ZB, N12AB, N13AB, N14A3, N15 AB]T (where τ indicates transposition). The observation quantity Z in Expression (8) is the double phase difference Φ^AB of the phase integrated value and the double phase difference O^AB of the pseudo range. For example, when there are four pairs (j, h) of paired GPS satellites 10, e.g., (1, 2), (1, 3), (1, 4), and ( (Λ1, J K)\, Z Υ - = M 1<P>12 AB, rf Φ»13 AB. < Φf>14 AB, < ΦT»15 AB, P r,12 AB, Λ P13 AB, P r.14 AB, P r,iS ABJ 1T-
[0056] Here, the observation equation of Expression (8) is linear, but the observation quantity Z in Expressions (4) and (7) is nonlinear regarding the state variables XB, YB, and ZB- Therefore, the terms in Expressions (4) and (7) are each partially differentiated by the state variables XB, YB, and ZB to obtain the observation matrix H in Expression (8) above. For example, when there are four pairs (j, h) of paired GPS satellites 10, e.g., (1, 2), (1, 3), (1, 4), and (1, 5), the observation matrix H is as shown below.
Figure imgf000019_0001
[0057] The term Hi in Expression (9) is an observation matrix when the observation quantity Zi = [Φ12AB, Φ13 AB, ΦM AB, Φ15AB]T- The term H2 in Expression (9) is an observation matrix when the observation quantity Z2 = [p12 AB, P13AB, P14AB, P15AB]T-
The observation matrix H incorporates both of these two observation matrixes H1 and H2.
[0058] When Expression (8) above is solved by the least squares method using the observation matrix H in Expression (9), the real root (i.e., the float root) of η (i) can be obtained as shown below, η (i) = (Hτ (i) x H (J))"1 x Hτ (i) x Z (i) ... (10) [0059] The interferometric positioning calculating portion 66 also calculates the integer solution of the integer bias, i.e., the double phase difference NJIIAB of the integer bias, based on the real root (i.e., the float root) of the integer bias calculated as described above. More specifically, the interferometric positioning calculating portion 66 obtains the integer root (i.e., the wave number) with the smallest error with respect to the calculated real root, for example, as a first candidate, and then obtains the integer solution with the next smallest error as the second candidate. The LAMBDA method, which solves a problem by decorrelating the integer bias and narrowing the search domain of the integer solution, may also be used for this method. Alternatively, instead of the LAMBDA method, an integer solution may be derived by the least squares method of another integer or by rounding off.
[0060] According to this process, the coordinate XB of the non-reference vehicle B in which the coordinate of the reference vehicle A is a known value can be obtained, so the vector XAB can be obtained. Also, the double phase difference N^AB of the integer bias can be obtained. In this example embodiment, the RTK positioning calculation is performed using one sample of data, so it is expected that the processing will be easy and quick compared to when a RTK positioning calculation is performed in time series using a Kalman filter or the like.
[0061] When the non-reference vehicle B calculates the vector XAB and the double phase difference N^AB of the integer bias, and the non-reference vehicle C calculates the vector XAc and the double phase difference N*h Ac of the integer bias, the vector XAB, the double phase difference NJHAB of the integer bias of two (i.e., a pair of) satellites, and a single phase difference Φ*hβ (= Φ*B - Φhβ) of the phase integrated value related to the same pair of satellites are transmitted from the non-reference vehicle B to the non-reference vehicle C (S108).
[0062] Then, the reliability determining portion 68 in the non-reference vehicle C determines the reliability (i.e., makes a reliability determination) (SIlO). This reliability determination is made based on whether Expression (11) below is satisfied. If Expression (11) is satisfied, the reliability of the calculated double phase difference of the integer bias is high so it can be determined that the reliability of the calculated relative positions among vehicles A, B, and C is high. In the expression, Φ*h Bc is the double phase difference (= O111B - Φ^hc) of the phase integrated value, λ is the wavelength (approximately 20 [cm]) of the carrier, and α is a predetermined value set in advance to a value equal to or less than 2 / λ (such as approximately 5 to 10 [cm]). Incidentally, f (xB, xc) is expressed by Expression (12). The coordinate XB of the non-reference vehicle B is obtained by adding the vector XAB to the coordinate XA of the reference vehicle A. Also, the coordinate Xc of the non-reference vehicle C is obtained by adding the vector XAC to the coordinate xA of the reference vehicle A. I ΦV - { f (XB, xc) + λ (NjhAB, Njh AC) } [ < a ... (11) f (XB, XC) = [ /"{ (XB - Xj) }2 - /"{ (XB - Xh) Ϋ ) - [ /"{ (xC - Xj) Ϋ - ^{ (xc - Xh) Ϋ ] ... (12)
[0063] The non-reference vehicle C then transmits the results of the reliability determination to the reference vehicle A and the non-reference vehicle B (S 112 and S 114). If the determination results obtained by the non-reference vehicle C indicate high reliability, the integer solution is fixed in the vehicles (S116, S118, and S120), and then the relative positions among the vehicles are calculated by RTK positioning calculations using that integer solution. If, on the other hand, the determination results obtained by the non-reference vehicle C indicate low reliability, the integer solution is not fixed in the vehicles. Instead, interim measures are taken, e.g., the relative positions are tentatively calculated using the last obtained integer solution.
[0064] According to this process, the reliability of the integer bias can be efficiently determined when three or more vehicles detect their relative positions by the RTK positioning calculation. The data transmitted from the non-reference vehicle B to the non-reference vehicle C is the vector XAB, the double phase difference Njh AB of the integer bias of two (i.e., a pair of) satellites, and a single phase difference Φ^B of the phase integrated value related to the same pair of satellites. However, when performing the RTK positioning calculation between vehicles B and C, the position of either one of the vehicles according to single point positioning must be transmitted when necessary, in addition to the phase integrated values of at least five satellites. Also, the processing load of the RTK positioning calculation itself is relatively large.
[0065] Therefore, the communication and processing loads can be reduced compared to what they are when determining the reliability by performing RTK positioning calculations between vehicles A and B, between vehicles A and C, and between vehicles B and C, and then performing a ratio test or the like. Also, there is no bothersome processing that is otherwise required when there is a discrepancy between the results from performing the RTK positioning calculations between vehicles A and B, between vehicles A and C, and between vehicles B and C. [0066] Accordingly, the relative position detecting system 1 and the relative position detecting apparatus 30 that makes up this relative position detecting system 1 in this example embodiment are able to obtain the relative positions among three or more movable objects by interferometric positioning, and efficiently determine the reliability of the interferometric positioning. [0067] Hereinafter, a relative position detecting system 2 according to a second example embodiment of the invention will be described. This relative position detecting system 2 is realized by the same hardware structure as the first example embodiment and will therefore be described with reference to the description of the first example embodiment and FIGS. 1 and 2. Also, descriptions of the hardware of the constituent elements and the technical background will be omitted.
[0068] Similar to the first example embodiment, the control device 60 according to this example embodiment has the communication control portion 62, the single point positioning calculating portion 64, the interferometric positioning calculating portion 66, and the reliability determining portion 68. [0069] In a predetermined situation in which communication is possible with two or more other vehicles, the communication control portion 62 communicates with the other vehicles and assigns a role of (1) a reference vehicle or (2) a non-reference vehicle to the three of more vehicles including the host vehicle.
[0070] The single point positioning calculating portion 64 and the interferometric positioning calculating portion 66 have the same functions as they do in the first example embodiment. That is, the single point positioning calculating portion 64 calculates the position of the host vehicle by single point positioning, and the interferometric positioning calculating portion 66 calculates the relative position of the host vehicle with respect to the reference vehicle and the double phase difference of the integer bias regarding the relationship with the reference vehicle when the host vehicle is a non-reference vehicle.
[0071] Similar to the first example embodiment, in the system 2 of this example embodiment as well, the non-reference vehicle performs a RTK positioning calculation using i) the received data, i.e., the Ll data, the L2 data, and the C/A data of the five satellites, and the position of the vehicle according to single point positioning calculated by the single point positioning calculating portion 64, which aTe all transmitted from the reference vehicle to the non-reference vehicle, and ii) the observation data observed by the non-reference vehicle, and calculates its relative position (vector) with respect to the reference vehicle and the double phase difference of the integer bias regarding the relationship with the reference vehicle. Then the non-reference vehicle performs a ratio test or the like to determine the reliability of the RTK positioning calculation. Hereinafter, the reference vehicle will be designated by the letter A and the non-reference vehicles will be designated by the letters B and C. [0072] FIG 5 is a flowchart illustrating the flow of the process executed by the control apparatuses 60 (mainly the reliability determining portions 68) of the non-reference vehicles after performing the RTK positioning calculation. Here, only the process of the non-reference vehicle B will be described.
[0073] First, the reliability determining portion 68 performs a ratio test (S200) on the integer bias N^AB calculated by the interferometric positioning calculating portion 66.
[0074] The ratio test is performed as described below. For example, a case will be assumed in which there are four pairs (j, h) of paired GPS satellites 10, e.g., (1, 2), (1, 3), (1, 4), and (1, 5), and the real roots of four integer biases (n12, n13, n14, and n15) and the first candidates
Figure imgf000024_0001
N13U N14 J, and N15O and second candidates (N12 2, Nu 2, N14 2, and N15 2) of integer solutions of the integer biases are calculated. In this case, the ratio R is a ratio of i) the range (norm) between the real root of the integer bias and the first candidate of the integer solution of the integer bias to ii) the range between the real root of the integer bias and the second candidate of the integer solution of the integer bias, as shown below. The ratio R is typically indicates that the reliability of the first candidate of the integer solution of the integer bias increases as the value increases. R = {(n12 - N12 2)2 + (n13 - N13 2)2 + (n14 - N14 2)2 + (n15 - N15 2)2} / {(n12 - N12O2 + (n13 - N13O2 + (n14 - N14,)2 + (n15 - Nl\)2} ... (13) [0075] Then the ratio R is compared with predetermined values βi and β2 and the reliability is determined from among three levels, i.e., high, medium, and low (S202). That is, if the ratio R is equal to or greater than the predetermined value βi (e.g., a value of approximately 3), the reliability is determined to be high. If the ratio R is equal to or greater than the predetermined value β2 (e.g., approximately 1.5) but less than the predetermined value βi, the reliability is determined to be medium. If the ratio R is less than the predetermined value β2, the reliability is determined to be low.
[0076] If the reliability is high, a signal indicating such is transmitted to the other non-reference vehicle C (S204). If a signal indicating that the reliability as determined by the non-reference vehicle C is high is also received from the non-reference vehicle C, it is determined that the integer solutions of the integer biases calculated by the non-reference vehicles B and C this time are correct and those integer solutions are fixed in the vehicles. Then the relative positions among the vehicles are calculated by RTK positioning calculations using those integer solutions (S206 and S208).
[0077] If, ,on the other hand, the reliability is medium, the observation data of the non-reference vehicle C is requested and obtained (S210). Then, the interferometric positioning calculating portion 66 is instructed to perform a RTK positioning calculation for the relationship between the Host vehicle and the reference vehicle C (S212). Moreover, it is determined whether the calculated double phase difference Njh Bc of the integer bias matches the difference between N^AB and Njh Ac (S214). If the double phase difference of the integer bias matches that difference, then the reliability is regarded as being high and a signal indicating such is transmitted to the other non-reference vehicle C (S204).
[0078] If it is determined in step S202 that the reliability is low, and it is determined in step S214 that the double phase difference of the integer bias does not match, the satellite responsible for lowering the ratio R is identified (S216). More specifically, ratio tests are performed sequentially omitting one of the pairs (1, 2), (1, 3),
(1, 4), and (1, 5) in the example give above. If the ratio R increases to equal to or greater than a predetermined value when a given pair, e.g., (1, 3), is omitted, it is determined that the corresponding satellite, i.e., the third satellite in this case, is responsible for lowering the ratio R.
[0079] The reliability is determined by comparing the ratio R calculated by the ratio test performed with the identified satellite omitted with the predetermined values βx and β2 (S218). If the reliability here is high, the reliability is regarded as being high and a signal indicative of such is transmitted to the other non-reference vehicle C (S204).
[0080] If in step S218 the reliability is medium or low, it is determined whether the inequality expression of Expression (11) described in the first example embodiment is satisfied (S220) using the phase integrated value Φ^H BC calculated according to the observation data obtained in step S212 (i.e., by requesting and obtaining the observation data of the non-reference vehicle C when step S212 is not performed). In this case, the observation data for the satellite for which the radio signal was not observed with the reference vehicle A may be reflected in the phase integrated value Φ^BC- Also, Expression (11) is calculated by selecting two satellites so any pair of satellites, except for the satellite that was identified in step S216, is selected. If the inequality expression in Expression (11) is satisfied, the reliability is regarded as being high so a signal indicating such is transmitted to the other non-reference vehicle C (S204).
[0081] If the determination in step S220 is No, it is determined that the currently calculated integer bias is unreliable so the signal indicating that the reliability is high is not transmitted from the non-reference vehicle B to the non-reference vehicle C (S222). That is, the integer solution of the integer bias is not fixed. In this case, interim measures are taken such as continuing to use the previously calculated integer bias.
[0082] According to the relative position detecting system 2 of this example embodiment, if the reliability is unable to be confirmed by a ratio test, another ratio test is performed omitting the satellite responsible for lowering the ratio R, so the reliability of the interferometric positioning can be improved.
[0083] While the invention has been described with reference to example embodiments thereof, it is to be understood that the invention is not limited to the example embodiments or constructions. Various modifications and substitutions are also possible without departing from the scope of the invention.
For example, in the example embodiments, the real root of the integer bias is obtained by an instantaneous positioning method. However, there are many methods for calculating the real root of the integer bias so a method other than that described above may be used. For example, a method may also be used which uses only the double phase difference of the phase integral value and does not use the double phase difference of the pseudo range.
[0084] Also, when the GPS receiver is a two frequency receiver capable of receiving both Ll and L2 waves (L2 being on a frequency of 1227.6 MHz) transmitted from a GPS satellite, the double phase difference of the phase integrated value for the L2 wave may be used additionally or alternatively as the observation quantity Z. Also, the double phase difference of a phase integrated value for a carrier of another band (such as the radio waves of an L5 band planned to be added in the future) may be used additionally or alternatively as the observation quantity Z. Similarly, with the double phase difference of a pseudo range as well, a single or double phase difference of a pseudo range based on a similar PRN code (pseudorandom noise code) other than a C/A code (such as a P code) may be used additionally or alternatively as the observation quantity Z. With the method for calculating the root solution of the integer bias described above, the effects from the clock error and the initial phase of the oscillator in the GPS receiver and the like are eliminated by using the double phase difference as described above, but a single phase difference may also be used. Also, in the method described above, the ionospheric layer refraction effect, the tropospheric refraction effect, and the multipath effect are ignored, but they may also be taken into account. [0085] Moreover, in the first example embodiment, after the non-reference vehicle C determines that the reliability is low, Mt may request and obtain the observation data of the non-reference vehicle B, perform interferometric positioning regarding the relationship between the non-reference vehicle B and the host vehicle, and determine whether the calculated double phase difference Njh Bc of the integer bias matches the difference between NJH AB and Njh Ac> just as in steps S212 and 214 in the second example embodiment. If it matches, the reliability may be regarded as being high.
[0086] Also, in the example embodiments described above, the invention is applied to GPS. However, the invention may also be applied to a satellite system other than GPS, such as another GNSS (Global Navigation Satellite System) such as Galileo, for example.
[0087] While some embodiments of the invention have been illustrated above, it is to be understood that the invention is not limited to details of the illustrated embodiments, but may be embodied with various changes, modifications or improvements, which may occur to those skilled in the art, without departing from the spirit and scope of the invention.
[0088] The invention may be used in automotive manufacturing and automotive parts manufacturing and the like.

Claims

CLAIMS:
1. A relative position detecting apparatus which is mounted in one movable object and detects the relative position of the one movable object with respect to another movable object, characterized by comprising: observation data obtaining means for obtaining observation data by observing a satellite signal; communicating means for communicating with the other movable object; positioning calculating means for performing a positioning calculation using the observation data obtained by the observation data obtaining means, and observation data received from the other movable object by the communicating means; and reliability determining means for determining the reliability of the results of the positioning calculation performed by the positioning calculating means, wherein, in a predetermined case in which three or more movable objects including the one movable object, one of the three or more movable objects being a reference movable object and the other two or more of the three or more movable objects being non-reference movable objects one of which is a first non-reference movable object and the other one or more of which is a second non-reference movable object, are able to communicate with each other: when the one movable object is the reference movable object, the communicating means transmits data that includes the observation data obtained by the observation data obtaining means to the other movable objects; when the one movable object is the second non-reference movable object, the positioning calculating means calculates the relative position of the one movable object with respect to the reference movable object by performing interferometric positioning that uses the obtained observation data and data that includes observation data received from the reference movable object, and the communicating means transmits data that includes an integer bias calculated in the interferometric positioning to the first non-reference movable objects, and receives the results from determining the reliability of the interferometric positioning based on the transmitted data that includes the integer bias from the first non-reference movable object; and when the one movable object is the first non-reference movable object, the positioning calculating means calculates the relative position of the one movable object with respect to the reference movable object by performing interferometric positioning using the obtained observation data and the data that includes observation data received from the reference movable object; the communicating means receives data that includes the integer bias from the second non-reference movable object; and the reliability determining means determines the reliability of the interferometric positioning based on the received data that includes the integer bias.
2. The relative position detecting apparatus according to claim 1, wherein it is determined whether the one movable object is the reference movable object based on communication with the other movable objects.
3. The relative position detecting apparatus according to claim 1, wherein when the one movable object is one of the non-reference movable objects, it is determined whether the one movable object is the first non-reference movable object or the second non-reference movable object based on communication with the other one or more non-reference movable objects.
4. A relative position detecting apparatus which is mounted in one movable object and detects the relative position of the one movable object with respect to another movable object, characterized by comprising: observation data obtaining means for obtaining observation data by observing a satellite signal; communicating means for communicating with the other movable object; positioning calculating means for performing a positioning calculation using the observation data obtained by the observation data obtaining means, and observation data received from the other movable object by the communicating means; and reliability determining means for determining the reliability of the results of the positioning calculation performed by the positioning calculating means, wherein, in a predetermined case in which three or more movable objects, including the one movable object, one of the three or more movable objects being a reference movable object and the other two or more of the three or more movable objects being non-reference movable objects one of which is a first non-reference movable object and the other one or more of which is a second non-reference movable object, are able to communicate with each other: when the one movable object is the reference movable object, the
. communicating means transmits data that includes the observation data obtained by the observation data obtaining means to the other movable objects; and when the one movable object is the second non-reference movable object, the positioning calculating means calculates the relative position of the one movable object with respect to the reference movable object by performing interferometric positioning using the obtained observation data and the data that includes observation data received from the reference movable object, and the reliability determining means performs a ratio test on the interferometric positioning, and if a ratio value of the performed ratio test is equal to or less than a predetermined value, the reliability determining means identifies the satellite signal related to the observation data responsible for lowering the ratio value and performs the ratio test again omitting the identified satellite signal.
5. The relative position determining apparatus according to claim 4, wherein it is determined whether the one movable object is the reference movable object based on communication with the other movable objects.
6. The relative position determining apparatus according to claim 4 or 5, wherein if the ratio value obtained is equal to or less than the predetermined value when the ratio test is performed again by the non-reference movable object that performed the ratio test again, the communicating means transmits and receives observation data to and from the other one or more non-reference movable objects, and the reliability determining means determines the reliability based on a comparison of i) the results of mterferometric positioning regarding the relationship between the one movable object and the reference movable object, and ii) the results of the interferometric positioning regarding the relationship between the one movable object and the other one or more non-reference movable objects performed by the positioning calculating means or the results of the interferometric positioning performed by the other one or more non-reference movable objects, or the communicating means receives reliability determination results from one of the other one or more non-reference movable objects.
7. The relative position determining apparatus according to claim 6, wherein it is determined, based on communication with the other one or more non-reference movable objects, whether the results that are to be compared with the results of interferometric positioning regarding the relationship between the one movable object and the reference movable object are the results of interferometric positioning regarding the relationship between the one movable object and the other one or more non-reference movable objects or the results of interferometric positioning performed by the other one or more non-reference movable objects.
8. The relative position determining apparatus according to claim 6 or 7, wherein the interferometric positioning regarding the relationship between the one movable object and the other one or more non-reference movable objects uses observation data of a satellite signal not used in the interferometric positioning regarding the relationship between the one movable object and the reference movable object.
9. A relative position detecting system characterized by comprising: three or more movable objects each of which is provided with observation data obtaining means for obtaining observation data by observing a satellite signal, communicating means for communicating with the other movable objects, and positioning calculating means for performing a positioning calculation using the observation data obtained by the observation data obtaining means and observation data received from the other movable objects by the communicating means, wherein, in a predetermined case in which the three or more movable objects, one of the three or more movable objects being a reference movable object and the other two or more of the three or more movable objects being non-reference movable objects one of which is a first non-reference movable object and the other one or more of which is a second non-reference movable object, are able to communicate with each other: the reference movable object transmits data that includes the observation data obtained by the observation data obtaining means to the other movable objects; the positioning calculating means of the non-reference movable objects calculate the relative positions of the non-reference movable objects with respect to the reference movable object by performing interferometric positioning using the obtained observation data and data that includes observation data received from the reference movable object; the second non-reference movable object transmits data that includes an integer bias calculated in the interferometric positioning to the first non-reference movable objects and receives the results from determining the reliability of the interferometric positioning based on the transmitted data that includes the integer bias from the first non-reference movable object; and the first non-reference movable object receives the data that includes the integer bias from the second non-reference movable object, and determines the reliability of the interferometric positioning based on the received data that includes the integer bias.
10. The relative position detecting system according to claim 9, wherein one of the movable objects is determined to be the reference movable object and the other movable objects are determined to be the non-reference movable objects by the three or more movable objects that make up the relative position detecting system communicating with each another.
11. The relative position detecting system according to claim 9 or 10, wherein it is determined, for each of the non-reference movable objects, whether the non-reference movable object is the first non-reference movable object or the second non-reference movable object by the non-reference movable objects communicating with each other.
12. A relative position detecting system characterized by comprising: three or more movable objects each of which is provided with observation data obtaining means for obtaining observation data by observing a satellite signal, communicating means for communicating with the other movable objects, and positioning calculating means for performing a positioning calculation using the observation data obtained by the observation data obtaining means and observation data received from the other movable objects by the communicating means, wherein, in a predetermined case in which the three or more movable objects, one of the three or more movable objects being a reference movable object and the other two or more of the three or more movable objects being non-reference movable objects one of which is a first non-reference movable object and the other one or more of which is a second non-reference movable object, are able to communicate with each other: the reference movable object transmits data that includes the observation data obtained by the observation data obtaining means to the other movable objects; and one of the non-reference movable objects uses the positioning calculating means to calculate the relative position of the non-reference movable object with respect to the reference movable object by performing interferometric positioning using the obtained observation data and data that includes the observation data received from the reference movable object, and performs a ratio test on the interferometric positioning, and if the ratio value of the performed ratio test is equal to or less than a predetermined value, identifies the satellite signal related to the observation data responsible for lowering the ratio value and performs the ratio test again omitting the identified satellite signal.
13. The relative position detecting system according to claim 12, wherein one of the movable objects is determined to be the reference movable object and the other movable objects are determined to be the non-reference movable objects by the three or more movable objects that make up the relative position detecting system communicating with each another.
14. The relative position detecting system according to claim 12 or 13, wherein if the ratio value obtained is equal to or less than the predetermined value when the ratio test is performed again by the non-reference movable object that performed the ratio test again, the non-reference movable object transmits and receives observation data to and from the other one or more non-reference movable objects, performs interferometric positioning regarding the relationship with the other one or more non-reference movable objects, and makes a reliability determination based on a comparison of i) the results of interferometric positioning regarding the relationship with the reference movable object, and ii) the results of the performed interferometric positioning or the results of the interferometric positioning performed by the other one or more non-reference movable objects, or receives reliability determination results from the one of the other one or more non-reference movable objects.
15. The relative position detecting system according to claim 14, wherein the non-reference movable objects communicate with each other and each non-reference movable object determines whether to perform interferometric positioning regarding the relationship with the other one or more non-reference movable objects or have one of the other one or more non-reference movable objects perform interferometric positioning.
16. The relative position detecting system according to claim 14 or 15, wherein observation data of a satellite signal not used in the interferometric positioning regarding the relationship with the reference movable object is used in the interferometric positioning regarding the relationship with the other one or more non-reference movable objects.
PCT/IB2009/005320 2008-04-23 2009-04-22 Relative position detecting apparatus, and relative position detecting system WO2009130570A2 (en)

Priority Applications (3)

Application Number Priority Date Filing Date Title
US12/989,007 US8259009B2 (en) 2008-04-23 2009-04-22 Relative position detecting apparatus, and relative position detecting system
DE112009001008T DE112009001008T5 (en) 2008-04-23 2009-04-22 Device for detecting a relative position and system for detecting a relative position
CN2009801145861A CN102016625B (en) 2008-04-23 2009-04-22 Relative position detecting apparatus, and relative position detecting system

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2008112968A JP4798168B2 (en) 2008-04-23 2008-04-23 Relative position detection device and relative position detection system
JP2008-112968 2008-04-23

Publications (2)

Publication Number Publication Date
WO2009130570A2 true WO2009130570A2 (en) 2009-10-29
WO2009130570A3 WO2009130570A3 (en) 2010-06-10

Family

ID=41064566

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/IB2009/005320 WO2009130570A2 (en) 2008-04-23 2009-04-22 Relative position detecting apparatus, and relative position detecting system

Country Status (5)

Country Link
US (1) US8259009B2 (en)
JP (1) JP4798168B2 (en)
CN (1) CN102016625B (en)
DE (1) DE112009001008T5 (en)
WO (1) WO2009130570A2 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20120029810A1 (en) * 2010-07-30 2012-02-02 Dai Liwen L System and Method for Moving-Base RTK Measurements

Families Citing this family (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2010097916A1 (en) * 2009-02-25 2010-09-02 トヨタ自動車株式会社 Vehicle-mounted information processing apparatus and information processing method
US9846241B2 (en) * 2010-07-30 2017-12-19 Deere & Company Navigation system and method using RTK with data received from a mobile base station
JP5013385B1 (en) * 2011-10-06 2012-08-29 独立行政法人電子航法研究所 Method and apparatus for selecting satellites used for RTK positioning calculation
JP2013142661A (en) * 2012-01-12 2013-07-22 Furuno Electric Co Ltd Radar device, radar positioning system, radar positioning method, and radar positioning program
US20140288824A1 (en) * 2013-03-22 2014-09-25 Qualcomm Incorporated Method and/or system for selective application of direction of travel
EP2793041A1 (en) * 2013-04-15 2014-10-22 Nederlandse Organisatie voor toegepast -natuurwetenschappelijk onderzoek TNO Assured vehicle absolute localisation
JPWO2016147569A1 (en) 2015-03-13 2018-01-18 パナソニックIpマネジメント株式会社 Satellite positioning system, electronic device and positioning method
JP6377169B2 (en) * 2015-09-16 2018-08-22 エスゼット ディージェイアイ テクノロジー カンパニー リミテッドSz Dji Technology Co.,Ltd System and method for estimating UAV position
EP3376249A1 (en) * 2017-03-17 2018-09-19 Veoneer Sweden AB Enhanced object position detection
CN108334076B (en) * 2018-01-09 2020-12-29 佛山科学技术学院 Super-individual assisted exercise system and exercise method thereof
US20220155448A1 (en) * 2019-05-16 2022-05-19 Mitsubishi Electric Corporation Information processing device, information processing method, and storage medium
US20220334594A1 (en) * 2019-09-13 2022-10-20 Sony Group Corporation Information processing system, information processing apparatus, and information processing program
CN111058447A (en) * 2019-12-27 2020-04-24 福建建中建设科技有限责任公司 Automatic position finding method and system for pile press

Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5610614A (en) * 1995-09-13 1997-03-11 Trimble Navigation Limited Real-time kinematic initialization test system
WO1998037433A1 (en) * 1997-02-20 1998-08-27 Ratheon Aircraft Montek Company System and method for determining high accuracy relative position solutions between two moving platforms
US6259398B1 (en) * 2000-05-19 2001-07-10 Sri International Multi-valued variable ambiguity resolution for satellite navigation signal carrier wave path length determination
US20020032525A1 (en) * 2000-09-12 2002-03-14 Mitsubishi Denki Kabushiki Kaisha GPS receiving system
US20020097181A1 (en) * 2000-12-04 2002-07-25 Andrew Chou Location-determination method and apparatus
US20040145518A1 (en) * 2001-12-19 2004-07-29 Furuno Electric Company Limited Carrier-phase-based relative positioning device
US20050002481A1 (en) * 2003-07-03 2005-01-06 Woo Richard Kai-Tuen Two-way RF ranging system and method for local positioning
EP1498745A2 (en) * 2003-07-02 2005-01-19 Thales North America, Inc. Enhanced real time kinematics determination method and apparatus
GB2410653A (en) * 2004-01-28 2005-08-03 Motorola Inc Locating a mobile device using GPS and/or GPS data from local mobile devices
WO2005081013A1 (en) * 2003-10-06 2005-09-01 The Insitu Group Method and apparatus for satellite-based relative positioning of moving platforms
WO2007111621A1 (en) * 2006-03-27 2007-10-04 Sony Ericsson Mobile Communications Ab Cooperative global positioning system (gps) processing by mobile terminals that communicate via an ad hoc wireless network
WO2008035139A1 (en) * 2006-09-19 2008-03-27 Nokia Corporation Relative positioning

Family Cites Families (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0510008A (en) * 1991-07-02 1993-01-19 Misawa Homes Co Ltd Trough-receiving metal
JPH0943336A (en) * 1995-07-27 1997-02-14 Mitsubishi Motors Corp Relative position measuring method
JP3681241B2 (en) * 1996-11-19 2005-08-10 松下電器産業株式会社 Relative position calculation device
AUPP375498A0 (en) * 1998-05-29 1998-06-18 Small, David A method for creating a network positioning system (NPS)
JP2000035337A (en) * 1998-07-17 2000-02-02 Sanyo Electric Co Ltd Navigation apparatus
JP2001337155A (en) * 2000-05-29 2001-12-07 Jekku:Kk Baseline analysis computing system and storage medium
US6421008B1 (en) * 2001-02-12 2002-07-16 The Aerospace Corporation Method to resolve interferometric ambiguities
JP2003098246A (en) * 2001-09-26 2003-04-03 Mitsubishi Electric Corp Method of determining orbits of spacecraft group under formation navigation, and system therefor
JP2003270319A (en) 2002-03-18 2003-09-25 Matsushita Electric Ind Co Ltd Satellite positioning/computing method and satellite navigating/positioning device using the same
JP3932975B2 (en) * 2002-05-17 2007-06-20 アイシン・エィ・ダブリュ株式会社 Position detection device
JP2005077163A (en) * 2003-08-29 2005-03-24 Kenichi Mase Position measuring network, its terminal, and method of measuring position of dynamic position group
JP4055716B2 (en) * 2004-01-22 2008-03-05 株式会社デンソー Radio wave transmission device and navigation device
JP2005300415A (en) * 2004-04-14 2005-10-27 Matsushita Electric Ind Co Ltd Correction device
WO2006043123A1 (en) * 2004-10-21 2006-04-27 Nokia Corporation Satellite based positioning

Patent Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5610614A (en) * 1995-09-13 1997-03-11 Trimble Navigation Limited Real-time kinematic initialization test system
WO1998037433A1 (en) * 1997-02-20 1998-08-27 Ratheon Aircraft Montek Company System and method for determining high accuracy relative position solutions between two moving platforms
US6259398B1 (en) * 2000-05-19 2001-07-10 Sri International Multi-valued variable ambiguity resolution for satellite navigation signal carrier wave path length determination
US20020032525A1 (en) * 2000-09-12 2002-03-14 Mitsubishi Denki Kabushiki Kaisha GPS receiving system
US20020097181A1 (en) * 2000-12-04 2002-07-25 Andrew Chou Location-determination method and apparatus
US20040145518A1 (en) * 2001-12-19 2004-07-29 Furuno Electric Company Limited Carrier-phase-based relative positioning device
EP1498745A2 (en) * 2003-07-02 2005-01-19 Thales North America, Inc. Enhanced real time kinematics determination method and apparatus
US20050002481A1 (en) * 2003-07-03 2005-01-06 Woo Richard Kai-Tuen Two-way RF ranging system and method for local positioning
WO2005081013A1 (en) * 2003-10-06 2005-09-01 The Insitu Group Method and apparatus for satellite-based relative positioning of moving platforms
GB2410653A (en) * 2004-01-28 2005-08-03 Motorola Inc Locating a mobile device using GPS and/or GPS data from local mobile devices
WO2007111621A1 (en) * 2006-03-27 2007-10-04 Sony Ericsson Mobile Communications Ab Cooperative global positioning system (gps) processing by mobile terminals that communicate via an ad hoc wireless network
WO2008035139A1 (en) * 2006-09-19 2008-03-27 Nokia Corporation Relative positioning

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20120029810A1 (en) * 2010-07-30 2012-02-02 Dai Liwen L System and Method for Moving-Base RTK Measurements
US8983685B2 (en) * 2010-07-30 2015-03-17 Deere & Company System and method for moving-base RTK measurements

Also Published As

Publication number Publication date
US8259009B2 (en) 2012-09-04
JP4798168B2 (en) 2011-10-19
US20110037647A1 (en) 2011-02-17
JP2009264844A (en) 2009-11-12
WO2009130570A3 (en) 2010-06-10
DE112009001008T5 (en) 2011-02-24
CN102016625B (en) 2013-09-18
CN102016625A (en) 2011-04-13

Similar Documents

Publication Publication Date Title
US8259009B2 (en) Relative position detecting apparatus, and relative position detecting system
JP4853490B2 (en) Inter-mobile interference positioning system, apparatus and method
US8593340B2 (en) Inter-mobile body carrier phase positioning device and method
US20090189804A1 (en) Satellite differential positioning receiver using multiple base-rover antennas
JP2005164395A (en) Carrier wave phase type gps positioning apparatus and method
US11781868B2 (en) System and method for GNSS reflective surface mapping and position fix estimation
JP2009025233A (en) Carrier phase positioning system
CN113063425B (en) Vehicle positioning method and device, electronic equipment and storage medium
JP5642919B2 (en) Carrier phase type mobile positioning device
JP5636410B2 (en) Moving information determination apparatus, receiver, and method therefor
JP2008039690A (en) Carrier-wave phase type position measuring instrument
JP2008039691A (en) Carrier-wave phase type position measuring instrument
JP5077054B2 (en) Mobile positioning system
US9086479B2 (en) Convergence zone
WO2009028929A1 (en) Device and method for calculating position of mobile station
JP2023508604A (en) System and method for GNSS positioning without integers
JP4400330B2 (en) Position detection apparatus and position detection method
JP2005147952A (en) Device for detecting position, and method therefor
JP5062141B2 (en) Positioning device for moving objects
EP2574962A2 (en) A moving information determination apparatus, a receiver, and a method thereby
CN117949988A (en) Positioning method, positioning device, computer readable medium and electronic equipment
JP2009122020A (en) Gps positioning device and gps positioning method
WO2006046305A1 (en) Relative measuring method and relative measuring system using satellite

Legal Events

Date Code Title Description
WWE Wipo information: entry into national phase

Ref document number: 200980114586.1

Country of ref document: CN

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

Ref document number: 09733794

Country of ref document: EP

Kind code of ref document: A2

DPE1 Request for preliminary examination filed after expiration of 19th month from priority date (pct application filed from 20040101)
WWE Wipo information: entry into national phase

Ref document number: 12989007

Country of ref document: US

RET De translation (de og part 6b)

Ref document number: 112009001008

Country of ref document: DE

Date of ref document: 20110224

Kind code of ref document: P

122 Ep: pct application non-entry in european phase

Ref document number: 09733794

Country of ref document: EP

Kind code of ref document: A2