WO2016104032A1 - 姿勢角算出装置、姿勢角算出方法、および姿勢角算出プログラム - Google Patents
姿勢角算出装置、姿勢角算出方法、および姿勢角算出プログラム Download PDFInfo
- Publication number
- WO2016104032A1 WO2016104032A1 PCT/JP2015/083153 JP2015083153W WO2016104032A1 WO 2016104032 A1 WO2016104032 A1 WO 2016104032A1 JP 2015083153 W JP2015083153 W JP 2015083153W WO 2016104032 A1 WO2016104032 A1 WO 2016104032A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- calculation
- contribution
- posture angle
- angle
- angle calculation
- Prior art date
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/53—Determining attitude
- G01S19/54—Determining attitude using carrier phase measurements; using long or short baseline interferometry
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
- G01S5/0205—Details
- G01S5/0244—Accuracy or reliability of position solution or of measurements contributing thereto
Definitions
- the present invention relates to an attitude angle calculation device, an attitude angle calculation method, and an attitude angle calculation program for calculating an attitude angle of a moving body such as a ship, a flying object, and an automobile.
- the attitude calculation device described in Patent Document 1 includes four GPS antennas.
- the lengths of the base lines connecting the four antennas (base line lengths) are different.
- the attitude calculation device described in Patent Document 1 selects two antennas having the longest baseline length in a receiving state where positioning is possible.
- the posture calculation apparatus described in Patent Document 1 calculates the posture using the GPS signals received by the two GPS antennas.
- an object of the present invention is to provide an attitude angle calculation device, an attitude angle calculation method, and an attitude angle calculation program capable of calculating an attitude angle with high accuracy.
- the posture angle calculation device of the present invention includes a plurality of antennas, a plurality of reception units, a posture angle calculation unit, and a calculation condition determination unit.
- Each of the plurality of antennas receives a positioning signal from a positioning satellite.
- the plurality of receiving units are provided for each antenna constituting the plurality of antennas.
- the plurality of receiving units output calculation data using the positioning signals received by the antenna.
- the posture angle calculation unit calculates each component of the posture angle using the calculation data.
- the calculation condition determination unit determines the contribution of the calculation data to the calculation of the attitude angle for each attitude angle component from the positional relationship between the base line connecting two of the plurality of antennas and the positioning satellite.
- the calculation condition determination unit includes an accuracy deterioration index calculation unit that calculates an accuracy deterioration index for each attitude angle component from the positional relationship between the base line and the positioning satellite, and an accuracy deterioration index. And a contribution determination unit that determines the contribution using.
- the degree of contribution for each positioning satellite is determined using the accuracy deterioration index (DOP).
- DOP accuracy deterioration index
- the attitude angle can be calculated with high accuracy.
- FIG. 1 It is a block diagram which shows the structure of the navigation state calculation apparatus which concerns on the 1st Embodiment of this invention.
- the block diagram which shows the structure of the calculation condition determination part which concerns on the 1st Embodiment of this invention.
- Perspective view showing positional relationship between antenna and positioning satellite Plan view showing the relationship between the antenna and the projection position of the positioning satellite
- the flowchart which shows the processing flow of the navigation state calculation method which concerns on the 1st Embodiment of this invention.
- the flowchart which shows the determination process of the weighting coefficient in the navigation state calculation method which concerns on the 1st Embodiment of this invention.
- the flowchart which shows another processing flow of the navigation state calculation method which concerns on the 1st Embodiment of this invention.
- the block diagram which shows the structure of the navigation state calculation apparatus which concerns on the 2nd Embodiment of this invention.
- the top view which shows the pattern of the antenna utilized for the navigation state calculation apparatus which concerns on embodiment of this invention
- the block diagram which shows the structure of the navigation state calculation apparatus which concerns on the 3rd Embodiment of this invention.
- a navigation state calculation device, a navigation state calculation method, and a navigation state calculation program according to a first embodiment of the present invention will be described with reference to the drawings.
- the positioning signal shown in the present embodiment is a positioning signal of GNSS (Global Navigation Satelite System), specifically, GPS (Global Positioning System), GLONASS (Global Navigation Satelite System Signal). Note that not only a positioning signal of a single system but also positioning signals of a plurality of systems may be used.
- FIG. 1 is a block diagram showing a configuration of a navigation state calculation apparatus according to the first embodiment of the present invention.
- FIG. 2 is a block diagram illustrating a configuration of the calculation condition determination unit according to the first embodiment of the present invention.
- FIG. 3 is a diagram showing the positional relationship of the antennas according to the first embodiment of the present invention.
- a navigation state calculation device 10 including an attitude angle calculation device includes an antenna unit 100, reception units 11 ⁇ / b> A, 11 ⁇ / b> B, 11 ⁇ / b> C, 11 ⁇ / b> D, a phase difference calculation unit 12, and a calculation unit 13.
- the antenna unit 100 includes antennas 100A, 100B, 100C, and 100D.
- the calculation unit 13 includes an attitude angle calculation unit 131 and a calculation condition determination unit 132.
- the calculation condition determination unit 132 includes an accuracy deterioration index calculation unit 133 and a contribution determination unit 134.
- the antenna unit 100 is arranged at a position where the sky in the ship is open. As shown in FIG. 3, the arrangement pattern of the antennas 100A, 100B, 100C, and 100D has a two-dimensional spread.
- the antennas 100A, 100B, 100C, and 100D are respectively arranged at four corners of a square in a plan view.
- the antenna 100A and the antenna 100D are arranged so that the base line connecting these antennas 100A and 100D is parallel to the By direction of the BODY coordinate system (direction connecting the bow and stern (the bow-stern direction)).
- the antenna 100B and the antenna 100C are arranged so that the base line connecting these antennas is parallel to the By direction of the body coordinate system.
- the antenna 100A and the antenna 100B are arranged so that the base line connecting these antennas 100A and 100B is parallel to the Bx direction of the BODY coordinate system (direction connecting starboard and port (right port direction)).
- the distance between the antennas 100A and 100B, the distance between the antennas 100B and 100C, the distance between the antennas 100C and 100D, and the distance between the antennas 100D and 100A are shorter than the wavelength of the positioning signal. More specifically, the distance between these antennas is preferably about 1/2 ( ⁇ / 2) of the wavelength ⁇ of the positioning signal, for example. By setting the distance between the antennas to about ⁇ / 2, it is easy to determine the integer value bias.
- this arrangement is an example, and it is sufficient that two or more antennas are arranged. That is, it is only necessary to set at least one baseline.
- the antenna 100A is connected to the receiving unit 11A.
- the antenna 100A receives the positioning signal transmitted by the positioning signal and outputs it to the receiving unit 11A.
- the antenna 100B is connected to the receiving unit 11B.
- the antenna 100B receives the positioning signal transmitted by the positioning signal and outputs it to the receiving unit 11B.
- the antenna 100C is connected to the receiving unit 11C.
- the antenna 100C receives the positioning signal transmitted by the positioning signal and outputs it to the receiving unit 11C.
- the antenna 100D is connected to the receiving unit 11D.
- the antenna 100D receives the positioning signal transmitted by the positioning signal and outputs it to the receiving unit 11D.
- the receiving units 11A, 11B, 11C, and 11D are synchronized. For example, a common clock signal is input to the receiving units 11A, 11B, 11C, and 11D, and the receiving units 11A, 11B, 11C, and 11D capture and track the positioning signal in synchronization with the clock signal. Do.
- the receiving unit 11A captures and tracks the positioning signal, and calculates the pseudorange ⁇ A for each positioning signal (for each positioning satellite). The reception unit 11A outputs the pseudo distance ⁇ A to the calculation unit 13. Receiving unit 11A calculates a carrier phase measurements PY A for each positioning signal (each positioning satellite). The reception unit 11A outputs the carrier phase measurement value PY A to the phase difference calculation unit 12.
- the receiving unit 11B captures and tracks the positioning signal, and calculates the pseudorange ⁇ B for each positioning signal (for each positioning satellite).
- the reception unit 11B outputs the pseudo distance ⁇ B to the calculation unit 13.
- the receiving unit 11B calculates the carrier phase measurement value PY B for each positioning signal (for each positioning satellite).
- the receiving unit 11B outputs the carrier phase measurement value PY B to the phase difference calculation unit 12.
- Receiving unit 11C a positioning signal acquisition, tracking, and calculates the pseudorange [rho C for each positioning signal (each positioning satellite).
- the receiving unit 11 ⁇ / b> C outputs the pseudo distance ⁇ C to the calculation unit 13.
- Receiving unit 11C calculates a carrier phase measurements PY C every positioning signal (each positioning satellite).
- the receiving unit 11C outputs the carrier wave phase measurement value PY C to the phase difference calculating unit 12.
- Receiving portion 11D is a positioning signal acquisition, tracking, and calculates the pseudorange [rho D for each positioning signal (each positioning satellite). Receiving unit 11D outputs the pseudorange [rho D to the arithmetic unit 13. Receiving unit 11D calculates a carrier phase measurements PY D for each positioning signal (each positioning satellite). The reception unit 11D outputs the carrier phase measurement value PY D to the phase difference calculation unit 12.
- pseudo distances ⁇ A , ⁇ B , ⁇ C , ⁇ D , and carrier phase measurement values PY A , PY B , PY C , and PY D correspond to the calculation data of the present invention.
- the phase difference calculation unit 12 sets a base line by combining two of the antennas 100A, 100B, 100C, and 100D.
- the phase difference calculation unit 12 calculates a single phase difference for each baseline. For example, specifically, the phase difference calculation unit 12 executes the following process.
- the phase difference calculation unit 12 sets the antenna 100 ⁇ / b> A as a reference antenna as a base line.
- the phase difference calculation unit 12 calculates a single phase difference for each base line from the difference calculation of the carrier phase measurement values.
- the phase difference calculation unit 12 outputs the calculated single phase difference to the calculation unit 13.
- the calculation unit 13 analyzes the navigation message superimposed on the positioning signal and acquires the satellite position.
- the calculating part 13 should just acquire the position of the positioning satellite which is the transmission source of the positioning signal currently received by receiving part 11A, 11B, 11C, 11D at least. In addition, you may perform analysis of a navigation message and acquisition of the position of a positioning satellite by each receiving part 11A, 11B, 11C, 11D.
- Each antenna 100A, 100B, 100C, 100D position PO A, PO B, PO C , PO D may be used in known autonomous techniques.
- Attitude angle calculation unit 131 a satellite position and antenna position PO A, PO B, PO C , using a PO D, to calculate the direction cosines of each single phase difference between the antennas.
- the attitude angle calculation unit 131 uses the antenna positions P OA and P OB and the satellite positions of the positioning satellites that are the transmission sources of the positioning signals received by both the antennas 100A and 100B. , 100B, the direction cosine corresponding to the single phase difference is calculated.
- the attitude angle calculation unit 131 calculates the direction cosine corresponding to the single phase difference between the other antennas by the same method.
- the posture angle calculation unit 131 calculates the posture angle AT using the single phase difference between the antennas and the direction cosine matrix.
- the direction cosine matrix is a matrix for converting the BODY coordinate system into an absolute coordinate system such as the earth coordinate system.
- the attitude angle AT is composed of a roll angle ⁇ , a pitch angle ⁇ , and a yaw angle ⁇ . Note that at least the yaw angle ⁇ may be estimated as the posture angle AT.
- the attitude angle calculation unit 131 estimates and determines an integer value bias for each single phase difference between antennas using a known method such as the LAMDA method.
- the attitude angle calculation unit 131 calculates a geometric distance difference corresponding to the single phase difference between the antennas using the single phase difference between the antennas and the integer value bias.
- the posture angle calculation unit 131 calculates the posture angle AT by applying a least square method or the like using the geometric distance difference and the direction cosine matrix.
- the posture angle calculation unit 131 calculates the posture angle using the contribution for each single phase difference determined by the calculation condition determination unit 132.
- the contribution is, for example, a weighting coefficient. Therefore, the posture angle calculation unit 131 applies the weighting coefficient determined by the calculation condition determination unit 132 to the single phase difference and applies the least square method or the like to calculate the posture angle.
- the calculation condition determination unit 132 determines a contribution degree (for example, a weighting coefficient) from the positional relationship between the base line of each single phase difference and the positioning satellite according to a desired posture angle component. That is, the calculation condition determination unit 132 determines the contribution for each single phase difference based on which of the roll angle ⁇ , the pitch angle ⁇ , and the yaw angle ⁇ is calculated with high accuracy.
- the contribution level is an index that contributes to the calculation accuracy of the posture angle component. More specifically, the contribution level is an index that is set such that the higher the contribution level, the higher the accuracy of calculating the posture angle component.
- the degree of contribution corresponds to a weighting coefficient. The greater the weighting coefficient, the higher the contribution, and the smaller the weighting coefficient, the lower the contribution.
- FIG. 4 is a graph showing the azimuth dependency of the accuracy degradation index (Heading-DOP) in the heading direction.
- FIG. 5 is a graph showing the azimuth dependency of the accuracy degradation index (Pitch-DOP) in the pitch direction. 4 and 5, the horizontal axis represents the azimuth angle of the positioning satellite with reference to the reference position of the base line in the absolute coordinate system, and the base line directions ⁇ 0, ⁇ 1, ⁇ 2, and ⁇ 3 in each graph calculate a single phase difference. Indicates the orientation of the baseline in the absolute coordinate system.
- Heading-DOP the accuracy degradation index in the heading direction
- the accuracy degradation index in the heading direction decreases as the angle approaches 90 ° (right angle) with respect to the base line orientation.
- Heading-DOP increases rapidly.
- This azimuth angle dependency of Heading-DOP does not depend on the elevation angle of the positioning satellite. Further, the lower the elevation angle of the positioning satellite, the smaller the Heading-DOP.
- the calculation condition determination unit 132 uses the Heading-DOP to determine the yaw angle ⁇ or a weighting coefficient that is set for calculating the posture angle that includes the yaw angle ⁇ in the posture angle component.
- the calculation condition determination unit 132 sets the weighting coefficient larger as the Heading-DOP is smaller, and sets the weighting coefficient smaller as the Heading-DOP is larger.
- the calculation condition determination unit 132 sets a weighting coefficient for each combination of the base line and the positioning satellite. As a result, the combination of a baseline with a smaller Heading-DOP and a positioning satellite increases the contribution of a single phase difference in the calculation of the attitude angle.
- the combination of a baseline with a larger Heading-DOP and a positioning satellite increases the calculation of the attitude angle.
- the calculation condition determination unit 132 outputs the set weighting coefficient to the posture angle calculation unit 131.
- the posture angle calculation unit 131 can calculate the yaw angle ⁇ with high accuracy by calculating the posture angle using the weighting coefficient given from the calculation condition determination unit 132.
- Pitch-DOP accuracy degradation index in the pitch direction
- the Pitch-DOP increases rapidly as it approaches 90 ° (at right angles) to the baseline orientation.
- the azimuth angle dependency of Pitch-DOP does not depend on the elevation angle of the positioning satellite.
- the pitch-DOP becomes smaller as the elevation angle of the positioning satellite becomes lower.
- the calculation condition determination unit 132 uses the Pitch-DOP to determine the pitch angle ⁇ or a weighting coefficient that is set to calculate the posture angle that includes the pitch angle ⁇ in the posture angle component.
- the calculation condition determining unit 132 sets the weighting coefficient larger as the Pitch-DOP is smaller, and sets the weighting coefficient smaller as the Pitch-DOP is larger.
- the calculation condition determination unit 132 sets a weighting coefficient for each combination of the base line and the positioning satellite.
- the calculation condition determination unit 132 outputs the set weighting coefficient to the posture angle calculation unit 131.
- the posture angle calculation unit 131 can calculate the pitch angle ⁇ with high accuracy by calculating the posture angle using the weighting coefficient given from the calculation condition determination unit 132.
- a desired posture angle component can be calculated with high accuracy.
- the weighting coefficient for each combination of the base line and the positioning satellite is set using the accuracy degradation index.
- the weighting coefficient may be set using the base line vector and the viewing direction vector of the positioning satellite from the base line.
- FIG. 6 is a perspective view showing the positional relationship between the antenna and the positioning satellite.
- FIG. 7 is a plan view showing the relationship between the antenna and the projection position of the positioning satellite. 6 and 7 show a case where the Bx axis direction of the Body coordinate system and the x axis direction of the absolute coordinate system match, and the By axis direction of the Body coordinate system matches the y axis direction of the absolute coordinate system. ing.
- the calculation condition determination unit 132 calculates the positional relationship between the base line and the positioning satellite.
- the calculation condition determining unit 132 projects the projection position of the positioning satellite onto the plane including the base line (the xy plane in FIGS. 6 and 7) and the reference position of the base line (the start point of the base line in FIGS. 6 and 7). The angle formed by the line connecting the lines and the base line is calculated.
- the calculation condition determination unit 132 sets a base line vector VctAD that connects the antennas 100A and 100D.
- Baseline vector VctAD is determined by the positions of antennas 100A and 100D.
- the positions of the antennas 100A and 100D are calculated from the pseudo distances ⁇ A and ⁇ D by independent positioning.
- the calculation condition determination unit 132 sets a line-of-sight direction vector VctA1 connecting the antenna 100A and the positioning satellite SV1.
- the line-of-sight direction vector VctA1 is determined by the positions of the antenna 100A and the positioning satellite SV1.
- the position of the positioning satellite SV1 is obtained by analyzing the navigation message.
- the calculation condition determination unit 132 sets a line-of-sight vector VctA2 that connects the antenna 100A and the positioning satellite SV2.
- the line-of-sight direction vector VctA2 is determined by the positions of the antenna 100A and the positioning satellite SV2.
- the position of the positioning satellite SV2 is obtained by analyzing the navigation message.
- the calculation condition determination unit 132 uses, for example, an inner product calculation of the base line vector VctAD and the line-of-sight direction vector VctA1, a base line connecting the antennas 100A and 100D, a projection position of the positioning satellite SV1, and a base line reference position (FIGS. 4 and 5). If so, the angle formed by the line connecting the position of the antenna 100A) is calculated. Similarly, the calculation condition determination unit 132 connects the base line connecting the antennas 100A and 100D, the projection position of the positioning satellite SV2, and the reference position of the base line using, for example, an inner product calculation of the base line vector VctAD and the line-of-sight direction vector VctA2. Calculate the angle formed by the line. At this time, the formed angle is calculated to be 90 ° or less.
- the calculation condition determining unit 132 increases the weighting coefficient for the positioning satellite as the angle formed with respect to the base line is closer to 90 ° (right angle), and the angle formed with respect to the base line is closer to 0 ° (parallel). Set a small weighting coefficient for positioning satellites.
- the yaw angle ⁇ can be calculated with high accuracy in the same manner as the setting of the weighting coefficient using the above-mentioned Heading-DOP.
- the calculation condition determination unit 132 increases the weighting coefficient for the positioning satellite as the angle formed with respect to the base line approaches 0 ° (parallel), and as the angle formed with respect to the base line approaches 90 ° (right angle). Set a small weighting coefficient for positioning satellites.
- the yaw angle ⁇ can be calculated with high accuracy in the same manner as the setting of the weighting coefficient using the Pitch-DOP described above.
- the weighting coefficient is set based on the angle formed with respect to the base line, but the elevation angle may be used. As shown in FIGS. 4 and 5, the Heading-DOP and the Pitch-DOP are improved as the elevation angle is lower. Therefore, the correction may be performed such that the weighting coefficient is increased as the elevation angle is lower, and the weighting coefficient is decreased as the elevation angle is higher.
- FIG. 8 is a flowchart showing a processing flow of the navigation state calculation method according to the first embodiment of the present invention.
- the information processing apparatus calculates the pseudo distance and the carrier phase measurement value from the positioning signals received by the plurality of antennas 100A, 100B, 100C, and 100D (S101).
- the information processing device demodulates the received positioning signal and analyzes the navigation message.
- the information processing apparatus acquires the satellite position from the navigation message (S102).
- the information processing apparatus determines a weighting coefficient for each combination of the base line and the positioning satellite from the positional relationship between the base line and the positioning satellite (S103). Specifically, the information processing apparatus determines the weighting coefficient using the process shown in FIG. FIG. 9 is a flowchart showing weighting coefficient determination processing in the navigation state calculation method according to the first embodiment of the present invention.
- the information processing apparatus calculates Heading-DOP for each combination of the base line and the positioning satellite (S131).
- the information processing apparatus calculates Pitch-DOP for each combination of the base line and the positioning satellite (S132).
- the information processing apparatus determines a weighting coefficient for each combination of the base line and the positioning satellite using Heading-DOP or Pitch-DOP according to a desired attitude angle component (S133).
- one of the Heading-DOP and the Pitch-DOP may be calculated according to a desired posture angle component. Specifically, if the posture angle component that requires high-accuracy calculation is the yaw angle ⁇ , only the Haeding-DOP may be calculated and the weighting coefficient determined from the Heading-DOP. If the posture angle component that requires highly accurate calculation is the pitch angle ⁇ , only the Pitch-DOP may be calculated and the weighting coefficient determined from the Pitch-DOP.
- the information processing apparatus calculates a single phase difference between the antennas for each baseline (S104).
- the information processing apparatus calculates the posture angle using the pseudo distance, single phase difference, and weighting coefficient set for each single phase difference (S105).
- the weighting coefficient for calculating the attitude angle is determined from the accuracy degradation index or the positional relationship between the baseline vector and the line-of-sight direction vector.
- a combination of the base line and the positioning satellite used for calculating the attitude angle may be selected from the accuracy degradation index or the positional relationship between the base line vector and the line-of-sight direction vector.
- FIG. 10 is a flowchart showing another processing flow of the navigation state calculation method according to the first embodiment of the present invention.
- FIG. 10 illustrates a case where an accuracy deterioration index is used.
- the information processing apparatus calculates the pseudo distance and the carrier phase measurement value from the positioning signals received by the plurality of antennas 100A, 100B, 100C, and 100D (S201).
- the information processing device demodulates the received positioning signal and analyzes the navigation message.
- the information processing apparatus acquires the satellite position from the navigation message (S202).
- the information processing apparatus calculates an accuracy deterioration index for each combination of the base line and the positioning satellite from the positional relationship between the base line and the positioning satellite (S203).
- the information processing apparatus selects a combination of the base line and the positioning satellite used for calculating the attitude angle using the accuracy deterioration index (S204). Specifically, the information processing apparatus sets a threshold value in advance for the accuracy degradation index. If the accuracy degradation index is equal to or less than the threshold value, the information processing apparatus selects a combination of the base line and the positioning satellite that is the accuracy degradation index to be used for the attitude angle calculation process. If the accuracy degradation index is larger than the threshold value, the information processing apparatus selects the combination of the baseline and the positioning satellite that is the accuracy degradation index to be excluded from the attitude angle calculation process. This selection process differs depending on the desired posture angle component. When calculating the yaw angle ⁇ , Heading-DOP is used, and when the pitch angle ⁇ is calculated, Pitch-DOP is used.
- the information processing apparatus sets a threshold for the angle formed by the baseline vector and the line-of-sight direction vector.
- the information processing apparatus selects the combination of the base line and the positioning satellite that form the formed angle to be used for the calculation process of the yaw angle ⁇ . If the formed angle is equal to or less than the threshold value, the information processing apparatus selects the combination of the base line and the positioning satellite that form the formed angle from the calculation process of the yaw angle ⁇ . That is, the contribution to the calculation process of the yaw angle ⁇ is set to zero. On the other hand, if the formed angle is equal to or less than the threshold value, the information processing apparatus selects the combination of the base line and the positioning satellite that form the formed angle to be used for the calculation processing of the pitch angle ⁇ .
- the information processing apparatus selects the combination of the base line and the positioning satellite constituting the formed angle from the calculation process of the pitch angle ⁇ . That is, the contribution to the calculation process of the yaw angle ⁇ is set to zero.
- the information processing apparatus calculates the attitude angle using the pseudorange and single phase difference obtained by the combination of the selected baseline and the positioning satellite.
- the selection of the combination of the base line and the positioning satellite is executed by the calculation condition determination unit 132 in the aspect in which the above-described processes are executed for each functional unit.
- a desired posture angle component that is, a posture angle component that requires high-precision calculation can be calculated with high accuracy.
- the calculation of the posture angle using the weighting coefficient and the calculation of the posture angle using the selection may be appropriately adopted depending on the situation. For example, when the number of positioning satellites that can receive positioning signals is small, a weighting coefficient may be used. Thereby, even if the number of positioning satellites capable of receiving positioning signals is small, the attitude angle can be calculated with high accuracy. On the other hand, if the number of positioning satellites that can receive positioning signals is large, selection may be used. Thereby, the attitude angle can be calculated with high accuracy by using only the positioning satellite that improves the accuracy of calculating the attitude angle among many positioning satellites.
- FIG. 11 is a block diagram showing a configuration of a navigation state calculation apparatus according to the second embodiment of the present invention.
- the navigation state calculation device 10A adds an inertial sensor 20 to the navigation state calculation device 10 according to the first embodiment. Further, the navigation state calculation device 10A is different from the navigation state calculation device 10 in the configuration of the calculation unit 13A.
- the inertial sensor 20 includes an acceleration sensor 21 and an angular velocity sensor 22.
- the acceleration sensor 21 detects the acceleration a IMU and outputs it to the integration processing unit 135.
- the angular velocity sensor 22 detects the angular velocity ⁇ IMU and outputs it to the integration processing unit 135.
- the calculation unit 13A includes an error estimation unit 131A, a calculation condition determination unit 132, and an integration processing unit 135.
- the calculation condition determination unit 132 performs the same configuration and processing as in the first embodiment, and determines the weighting coefficient for the single phase difference for each combination of the baseline and the positioning satellite.
- the error estimation unit 131A includes pseudo distances ⁇ A , ⁇ B , ⁇ C , ⁇ D , carrier phase measurement values PY A , PY B , PY C , PY D , satellite position changes ⁇ Psat A , ⁇ Psat B , ⁇ Psat C , ⁇ Psat C and a single phase difference between antennas are input.
- the single phase difference between the antennas is calculated by the phase difference calculation unit 12. Further, the previous integrated position P UN , integrated speed V UN , and integrated attitude angle AT UN are input to the error estimating unit 131A.
- the error estimation unit 131A sets an observation value from these input values, and sets a Kalman filter that uses the position calculation error ⁇ P , the velocity calculation error ⁇ V , and the attitude angle calculation error ⁇ AT as estimated values. At this time, the error estimation unit 131A sets a Kalman filter using a weighting coefficient set for each single phase difference.
- the error estimation unit 131A performs arithmetic processing on the Kalman filter to estimate the position calculation error ⁇ P , the speed calculation error ⁇ V , and the attitude angle calculation error ⁇ AT and output the estimated error to the integration processing unit 135. And by doing weights the single phase difference, it is possible to estimate the calculation error epsilon AT attitude angle with high accuracy.
- the integrated processing unit 135 calculates the integrated position P UN , the integrated speed V UN , and the integrated attitude angle AT UN using the acceleration a IMU and the angular velocity ⁇ IMU . At this time, the integration processing unit 135 performs correction using the position calculation error ⁇ P , the speed calculation error ⁇ V , and the attitude angle calculation error ⁇ AT .
- the attitude angle can be calculated with high accuracy as in the first embodiment. Furthermore, in the configuration of the present embodiment, the position and speed can be calculated with high accuracy in accordance with the calculation accuracy of the posture angle.
- the attitude angle can be calculated even during a period in which the positioning signal cannot be received. Further, during the period in which the positioning signal can be received, the error of the inertial sensor 20 can be corrected using the positioning signal, so that the attitude angle can be calculated with high accuracy.
- FIG. 11 the aspect which performs each process with a different function part was shown, respectively.
- these functional units may be formed by a single information processing apparatus.
- a program for realizing the following navigation state calculation method is stored in advance, and the information processing apparatus may read and execute this program.
- FIG. 12 is a flowchart of the navigation state calculation method according to the second embodiment of the present invention.
- the information processing apparatus includes pseudoranges ⁇ A , ⁇ B , ⁇ C , ⁇ D , carrier phase measurement values PY A , PY B , PY C , PY D , and satellite position changes ⁇ Psat A , ⁇ Psat B , ⁇ Psat C , ⁇ Psat. D is calculated (S201).
- the information processing apparatus acquires the acceleration a IMU and the angular velocity ⁇ IMU from the inertial sensor 20.
- the information processing device demodulates the received positioning signal and analyzes the navigation message.
- the information processing apparatus acquires the satellite position from the navigation message (S202).
- the information processing apparatus determines a weighting coefficient for each combination of the base line and the positioning satellite from the positional relationship between the base line and the positioning satellite (S203).
- the information processing apparatus calculates a single phase difference between the antennas for each baseline (S204).
- the information processing apparatus uses a pseudo distance, a single phase difference, an integrated position P UN obtained by the previous calculation, an integrated speed V UN , an integrated attitude angle AT UN, and a weighting coefficient set for each single phase difference, A position calculation error ⁇ P , a speed calculation error ⁇ V , and a posture angle calculation error ⁇ AT are estimated (S205). At this time, the information processing apparatus uses a Kalman filter or the like to set a weight for error variance or the like.
- the information processing apparatus uses the acceleration a IMU , the angular velocity ⁇ IMU , the position calculation error ⁇ P , the velocity calculation error ⁇ V , and the attitude angle calculation error ⁇ AT, and uses the integrated position P UN , the integrated velocity V UN , and The integrated posture angle AT UN is calculated (S206).
- FIG. 13 is a plan view showing antenna patterns used in the navigation state calculation apparatus according to the embodiment of the present invention.
- the antenna unit 100 ′ includes antennas 100A, 100B, and 100C.
- the arrangement pattern of the antennas 100A, 100B, and 100C has a two-dimensional spread. That is, the antennas 100A, 100B, and 100C are arranged so that the antenna 100C is not arranged on a straight line passing through the antennas 100A and 100B.
- the distance between the antennas is the same as in the first embodiment.
- FIG. 14 is a block diagram showing a configuration of a navigation state calculation apparatus according to the third embodiment of the present invention.
- a display unit 30 is added to the navigation state calculation device 10 according to the first embodiment.
- the other configuration of the navigation state calculation device 10B is the same as that of the navigation state calculation device according to the first embodiment.
- the display unit 30 includes a display control unit 31 and a display 32.
- the posture angle calculated by the posture angle calculation unit 131 is input to the display control unit 31.
- the position of the positioning satellite acquired by demodulating the navigation message and the position of the antenna unit 100 (that is, the position of the ship) are input to the display control unit 31.
- the attitude angle, positioning satellite position, and own ship position are set in the same coordinate system.
- the display control unit 31 generates image data representing the position of the antenna unit 100 and the positioning satellite from the attitude angle AT, the position of the positioning satellite, and the position of the ship.
- the display control unit 31 outputs the image data to the display device 32.
- FIG. 15 is a diagram illustrating an example of an image output by the navigation state calculation apparatus according to the third embodiment of the present invention.
- the image includes an azimuth display unit 320 and a satellite position display unit 330.
- the direction display unit 320 and the satellite position display unit 330 are concentric circles.
- the satellite position display 330 is arranged inside the circle of the azimuth display unit 320.
- the direction display unit 320 includes symbols (N (north direction), S (south direction), E (east direction), W (west direction), 45, 135, 225, 315) indicating the direction in the earth coordinate system. . Each symbol is provided at an interval of 45 ° along the outer circumference of the azimuth display unit 320. Symbols 45, 135, 225, and 315 represent angles around E (east direction) with N (north direction) as a reference. In the azimuth display unit 320, the azimuth angle of the reference baseline is above the image.
- the satellite position display unit 330 includes a plurality of elevation angle auxiliary lines 331 each having a circular shape with a different radius.
- a plurality of elevation angle auxiliary lines 331 are concentric circles, and a circle with a smaller radius represents a higher elevation angle.
- the satellite position display unit 330 displays a symbol (positioning satellite symbol) 332 representing a positioning satellite.
- the positioning satellite symbol 332 represents the position of the positioning satellite with respect to the antenna unit 100.
- the position of the positioning satellite is represented by the azimuth angle and elevation angle of each positioning satellite viewed from the antenna unit 100 obtained from the visual field direction vector.
- the display position of the positioning satellite symbol 332 is determined by the distance from the center of the circle according to the elevation angle, and the position along the circumferential direction is determined by the azimuth angle.
- the positioning satellite symbol 332 includes a numerical value indicating a satellite number.
- the positioning satellite symbol 332 is displayed in a different color for each positioning system.
- the positioning satellite symbol 332 may adopt a display mode such as changing the display color or blinking only the one corresponding to the positioning satellite that is receiving the positioning signal. Further, the display mode of the positioning satellite symbol 332 may be changed depending on the antenna receiving the positioning signal.
- a symbol (antenna symbol) 341 indicating the antennas 100A, 100B, 100C, and 100D
- a symbol (baseline symbol) 342 indicating the base line Is displayed The antenna symbol 341 and the base line symbol 342 are displayed in the same arrangement pattern as the antenna unit 100.
- the antenna symbol 341 and the baseline symbol 342 are displayed such that the reference baseline extends in the vertical direction of the image.
- the symbol 341 only the symbol of the reference antenna (here, corresponding to the antenna 100A) is displayed in a display mode (color or the like) different from the symbols of other antennas.
- the base line symbol 342 is linear, and the base line used for positioning is displayed as a solid line, and the base line not used for positioning is displayed as a dotted line. Note that the reference antenna and base line can be selected, and the selected antenna and base line may be displayed in a display mode different from other antennas and base lines.
- the bow heading instruction symbol 350 is displayed on the outer periphery of the heading display unit 320.
- the heading direction instruction symbol 350 is displayed at a position corresponding to the heading.
- the operator can easily visually recognize the positioning satellites around the navigation state calculation device 10B.
- the operator can easily visually recognize the positional relationship between the base line and the positioning satellite.
- the operator can easily visually recognize the positioning satellite used for calculating the attitude angle and the reference baseline.
- 16 and 17 are diagrams showing display modes of the navigational state calculation device according to the third embodiment of the present invention.
- the temporary symbol 333 is arranged on the satellite position display unit 330 when the position on the display overlaps in the display by the positioning satellite symbol.
- the provisional symbol 333 is smaller than the positioning satellite symbol 332. Therefore, even if the positioning satellites are close to each other, the symbols are difficult to overlap or the overlapping size is small.
- Each temporary symbol 333 is accompanied by an annotation symbol 334.
- the annotation symbol 334 has the same display mode as the positioning satellite symbol, and is displayed outside the azimuth display unit 320.
- the annotation symbols 334 are displayed so as not to overlap. Since there is a sufficient area for display outside the orientation display unit 320, the annotation symbol 334 can be displayed so as not to overlap easily.
- the annotation symbol 334 and the provisional symbol 333 are connected by a drawing arrow symbol. Thereby, the visibility of all the positioning satellites can be improved.
- the temporary symbol 333 is arranged in the satellite position display unit 330.
- the provisional symbol 333 is smaller than the positioning satellite symbol 332.
- a detailed display symbol 335 is attached to the group of provisional symbols 333.
- the detailed display symbol 335 is connected to the group of provisional symbols 333 by a drawer arrow symbol.
- a satellite number group of positioning satellites constituting a group of provisional symbols is displayed. The satellite number group is displayed so that the arrangement order of the satellite numbers changes sequentially. Thereby, the visibility of all the positioning satellites can be improved.
- (A) Baseline vector test The length of the baseline vector calculated using the positioning signal is compared with the physical baseline length known in advance at the time of installation. When the difference between the calculated baseline vector length and the physical baseline length is less than the threshold, the single phase difference corresponding to the baseline vector is used to calculate the posture angle. When the difference between the calculated baseline vector length and the physical baseline length is equal to or greater than the threshold, the single phase difference corresponding to the baseline vector is excluded from the calculation of the posture angle.
- (C) Derivative Value Test of Heading Direction (Yaw Angle ⁇ ) of Baseline Vector The calculated yaw angle ⁇ is continuously obtained, and the time change amount of the yaw angle ⁇ is calculated. When the time variation ⁇ of the yaw angle ⁇ is less than the threshold value, the calculated yaw angle ⁇ is employed. When the time variation ⁇ of the yaw angle ⁇ is equal to or greater than the threshold value, the calculated yaw angle ⁇ is not adopted.
- (D) Inner product / outer product test of baseline vectors Calculates the inner product or outer product of two baseline vectors calculated using the positioning signal.
- the inner product or outer product of the two baseline vectors is calculated from the physical positional relationship of the antennas installed in advance. If the difference between the inner product due to the positioning signal and the inner product due to the physical position, or the difference between the outer product due to the positioning signal and the outer product due to the physical position is less than the threshold, the single phase difference corresponding to the baseline vector is calculated as the posture angle.
- the single phase difference corresponding to the baseline vector is calculated as the posture angle. Excluded from the calculation of.
- a mode in which a single phase difference between antennas is used as the phase difference is shown.
- a double phase difference between a vector (base line) connecting two antennas and a vector connecting two positioning satellites may be used.
- a reference positioning satellite is set.
- the contribution (weighted or selected / unselected) used to calculate the attitude angle is determined by the vector connecting the two antennas, the vector connecting the two positioning satellites, and the absolute value of the outer product. do it. More specifically, when the weighting coefficient is used, the weighting is increased as the absolute value of the outer product is larger, and the weight is decreased as the absolute value of the outer product is smaller. Also, when using selection / non-selection, set a threshold for the absolute value of the outer product, and if the absolute value of the outer product is equal to or greater than the threshold, select a positioning satellite to be used for calculating the outer product, and the absolute value of the outer product is less than the threshold If so, the positioning satellite used to calculate the outer product is not selected.
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
Abstract
Description
図4に示すように、基線の方位に対して90°(直角)に近づくにしたがって、ヘディング方向の精度劣化指数(以下、Heading-DOPと称する。)は小さくなる。基線の方位に対して0°(平行)に近づくにしたがって、Heading-DOPは、急激に大きくなる。このHeading-DOPの方位角依存性は、測位衛星の仰角に依存しない。また、測位衛星の仰角が低くなるほど、Heading-DOPは小さくなる。
図5に示すように、基線の方位に対して0°(平行)に近づくにしたがって、ピッチ方向の精度劣化指数(以下、Pitch-DOPと称する。)は小さくなる。基線の方位に対して90°(直角)に近づくにしたがって、Pitch-DOPは、急激に大きくなる。Pitch-DOPの方位角依存性は、測位衛星の仰角に依存しない。また、測位衛星の仰角が低くなるほど、Pitch-DOPは小さくなる。
上述の図4に示すように、ヨー角ψの場合、基線に対して成す角が90°(直角)に近くなるほどHeading-DOPは小さくなり、基線に対する成す角が0°(平行)に近くなるほどHeading-DOPは大きくなる。
上述の図5に示すように、ピッチ角θの場合、基線に対して成す角が0°(平行)に近くなるほどPitch-DOPは小さくなり、基線に対する成す角が90°(直角)に近くなるほどPitch-DOPは大きくなる。
情報処理装置は、基線毎にアンテナ間の一重位相差を算出する(S204)。
測位信号を用いて算出した基線ベクトルの長さと、予め設置時点に既知の物理的な基線長とを比較する。算出した基線ベクトルの長さと物理的な基線長との差が閾値未満である場合に、当該基線ベクトルに対応する一重位相差を、姿勢角の算出に利用する。算出した基線ベクトルの長さと物理的な基線長との差が閾値以上である場合に、当該基線ベクトルに対応する一重位相差を、姿勢角の算出から除外する。
測位信号を用いて算出した基線ベクトルの残差について、χ2乗検定を実施する。基線ベクトルの残差のχ2乗値が閾値未満である場合に、当該基線ベクトルに対応する一重位相差を、姿勢角の算出に利用する。基線ベクトルの残差のχ2乗値が閾値以上である場合に、当該基線ベクトルに対応する一重位相差を、姿勢角の算出から除外する。
算出されたヨー角ψを連続的に取得し、ヨー角ψの時間変化量を算出する。ヨー角ψの時間変化量δψが閾値未満である場合に、算出したヨー角ψを採用する。ヨー角ψの時間変化量δψが閾値以上である場合に、算出したヨー角ψを採用しない。
測位信号を用いて算出した2本の基線ベクトルの内積または外積を算出する。予め設置されたアンテナの物理的位置関係から2本の基線ベクトルの内積または外積を算出する。測位信号による内積と物理的位置による内積との差、または、測位信号による外積と物理的位置による外積との差が閾値未満である場合に、当該基線ベクトルに対応する一重位相差を、姿勢角の算出に利用する。測位信号による内積と物理的位置による内積との差、または、測位信号による外積と物理的位置による外積との差が閾値以上である場合に、当該基線ベクトルに対応する一重位相差を、姿勢角の算出から除外する。
算出された姿勢角の各成分(ロール角φ、ピッチ角θ、ヨー角ψ)を連続的に取得し、それぞれの時間変化量を算出する。姿勢角の各成分の時間変化量が閾値未満である場合に、算出した姿勢角を採用する。姿勢角の各成分の時間変化量が閾値以上である場合に、算出した姿勢角を採用しない。
11A,11B,11C,11D:受信部
12:位相差算出部
13,13A:演算部
20:慣性センサ
21:加速度センサ
22:角速度センサ
30:表示部
31:表示制御部
32:表示器
100:アンテナ部
100A:アンテナ
100A,100B,100C,100D:アンテナ
131:姿勢角算出部
131A:誤差推定部
132:算出条件決定部
133:精度劣化指標算出部
134:寄与度決定部
135:統合処理部
Claims (20)
- 測位衛星からの測位信号を受信する複数のアンテナと、
複数のアンテナを構成するアンテナ毎に設けられ、前記アンテナが受信した測位信号を用いて、算出用データを出力する複数の受信部と、
前記算出用データを用いて姿勢角の各成分を算出する姿勢角算出部と、
前記複数のアンテナの内の2つのアンテナを結ぶ基線と前記測位衛星との位置関係から、前記姿勢角の算出に対する前記算出用データの寄与度を、前記姿勢角の成分に応じて決定する算出条件決定部と、
を備える、姿勢角算出装置。 - 請求項1に記載の姿勢角算出装置であって、
前記算出条件決定部は、
前記基線と測位衛星との位置関係から、前記姿勢角の成分に応じた精度劣化指標を算出する精度劣化指標算出部と、
前記精度劣化指標を用いて前記寄与度を決定する寄与度決定部と、
を備える、姿勢角算出装置。 - 請求項2に記載の姿勢角算出装置であって、
前記寄与度決定部は、
前記精度劣化指標が所定閾値よりも大きい場合に前記寄与度を0にする、
姿勢角算出装置。 - 請求項2または請求項3に記載の姿勢角算出装置であって、
前記寄与度決定部は、
前記精度劣化指標が小さいほど前記寄与度を高く、前記精度劣化指標が大きいほど前記寄与度を低くする、
姿勢角算出装置。 - 請求項2乃至請求項4のいずれかに記載の姿勢角算出装置であって、
前記位相差は、前記基線を構成するアンテナ間の一重位相差であり、
前記算出条件決定部は、
前記基線の中心と測位衛星とを結ぶ直線と、前記基線との成す角が略直角となる測位衛星の算出用データの寄与度を大きくする、
姿勢角算出装置。 - 請求項2乃至請求項4のいずれかに記載の姿勢角算出装置であって、
前記位相差は、前記2つのアンテナを結ぶ基線のベクトルと、該2つのアンテナが受信した測位信号の送信元の2つの測位衛星を結ぶ衛星間ベクトルとの二重位相差であり、
前記算出条件決定部は、
前記基線のベクトルと前記衛星間ベクトルの成す角が略直角となる測位衛星の算出用データの寄与度を大きくする、
姿勢角算出装置。 - 請求項1乃至請求項6のいずれかに記載の姿勢角算出装置であって、
前記基線に対応する位相差を算出する位相差算出部を備え、
前記姿勢角算出部は、
前記算出用データと位相差とを用いて、前記姿勢角の成分を算出する、
姿勢角算出装置。 - 請求項1乃至請求項7のいずれかに記載の姿勢角算出装置であって、
前記姿勢角算出部は、
慣性センサの出力データも用いて前記姿勢角を算出する、
姿勢角算出装置。 - 請求項1乃至請求項8のいずれかに記載の姿勢角算出装置であって、
前記基線を含む平面における前記測位衛星の投影位置と前記基線とを表示する表示部を、
さらに備える、姿勢角算出装置。 - 請求項9に記載の姿勢角算出装置であって、
前記表示部は、
絶対方位をさらに表示する、
姿勢角算出装置。 - 測位衛星からの測位信号を受信する受信工程と、
複数のアンテナを構成するアンテナ毎に設けられ、前記アンテナが受信した測位信号を用いて、算出用データを出力する算出用データ出力工程と、
前記複数のアンテナの内の2つのアンテナを結ぶ基線と前記測位衛星との位置関係から、前記姿勢角の算出に対する前記算出用データの寄与度を、前記姿勢角の成分に応じて決定する算出条件決定工程と、
前記算出用データと前記寄与度を用いて姿勢角の各成分を算出する姿勢角算出工程と、
を有する、姿勢角算出方法。 - 請求項11に記載の姿勢角算出方法であって、
前記算出条件決定工程は、
前記基線と測位衛星との位置関係から、前記姿勢角の成分に応じた精度劣化指標を算出する精度劣化指標算出工程と、
前記精度劣化指標を用いて前記寄与度を決定する寄与度決定工程と、
を有する、姿勢角算出方法。 - 請求項12に記載の姿勢角算出方法であって、
前記寄与度決定工程は、
前記精度劣化指標が所定閾値よりも大きい場合に前記寄与度を0にする、
姿勢角算出方法。 - 請求項12または請求項13に記載の姿勢角算出方法であって、
前記寄与度決定工程は、
前記精度劣化指標が小さいほど前記寄与度を高く、前記精度劣化指標が大きいほど前記寄与度を低くする、
姿勢角算出方法。 - 請求項12乃至請求項14のいずれかに記載の姿勢角算出方法であって、
前記位相差は、前記基線を構成するアンテナ間の一重位相差であり、
前記算出条件決定工程は、
前記基線の中心と測位衛星とを結ぶ直線と、前記基線との成す角が略直角となる測位衛星の算出用データの寄与度を大きくする、
姿勢角算出方法。 - 請求項12乃至請求項14のいずれかに記載の姿勢角算出方法であって、
前記位相差は、前記2つのアンテナを結ぶ基線のベクトルと、該2つのアンテナが受信した測位信号の送信元の2つの測位衛星を結ぶ衛星間ベクトルとの二重位相差であり、
前記算出条件決定工程は、
前記基線のベクトルと前記衛星間ベクトルの成す角が略直角となる測位衛星の算出用データの寄与度を大きくする、
姿勢角算出方法。 - 請求項11乃至請求項16のいずれかに記載の姿勢角算出方法であって、
前記基線に対応する位相差を算出する位相差算出工程を、さらに有し、
前記姿勢角算出工程は、
前記算出用データと位相差とを用いて、前記姿勢角の成分を算出する、
姿勢角算出方法。 - 請求項11乃至請求項17のいずれかに記載の姿勢角算出方法であって、
前記姿勢角算出工程は、
慣性センサの出力データも用いて前記姿勢角を算出する、
姿勢角算出方法。 - 測位衛星からの測位信号を用いて姿勢角を算出する処理を情報処理装置に実行させる姿勢角算出プログラムであって、
前記情報処理装置は、
複数のアンテナが受信した前記測位信号を用いて、算出用データを出力する算出用データ出力処理と、
前記複数のアンテナの内の2つのアンテナを結ぶ基線と前記測位衛星との位置関係から、前記姿勢角の算出に対する前記算出用データの寄与度を、前記姿勢角の成分に応じて決定する算出条件決定処理と、
前記算出用データと前記寄与度を用いて姿勢角の各成分を算出する姿勢角算出処理と、
を実行する、姿勢角算出プログラム。 - 請求項19に記載の姿勢角算出プログラムであって、
前記情報処理装置は、
前記算出条件決定処理として、
前記基線と測位衛星との位置関係から、前記姿勢角の成分に応じた精度劣化指標を算出する精度劣化指標算出処理と、
前記精度劣化指標を用いて前記寄与度を決定する寄与度決定処理と、
を実行する、姿勢角算出プログラム。
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US15/540,023 US10514469B2 (en) | 2014-12-26 | 2015-11-26 | Attitude angle calculating device, method of calculating attitude angle, and attitude angle calculating program |
CN201580071014.5A CN107110979B (zh) | 2014-12-26 | 2015-11-26 | 姿态角计算装置、姿态角计算方法及存储介质 |
JP2016566053A JP6470314B2 (ja) | 2014-12-26 | 2015-11-26 | 姿勢角算出装置、姿勢角算出方法、および姿勢角算出プログラム |
EP15872601.8A EP3239740A4 (en) | 2014-12-26 | 2015-11-26 | Orientation angle calculation device, orientation angle calculation method, and orientation angle calculation program |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2014-264586 | 2014-12-26 | ||
JP2014264586 | 2014-12-26 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2016104032A1 true WO2016104032A1 (ja) | 2016-06-30 |
Family
ID=56150064
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2015/083153 WO2016104032A1 (ja) | 2014-12-26 | 2015-11-26 | 姿勢角算出装置、姿勢角算出方法、および姿勢角算出プログラム |
Country Status (5)
Country | Link |
---|---|
US (1) | US10514469B2 (ja) |
EP (1) | EP3239740A4 (ja) |
JP (1) | JP6470314B2 (ja) |
CN (1) | CN107110979B (ja) |
WO (1) | WO2016104032A1 (ja) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2018135187A1 (ja) * | 2017-01-17 | 2018-07-26 | 古野電気株式会社 | 方位角算出装置、方位角算出方法、および方位角算出プログラム |
CN111708069A (zh) * | 2020-07-01 | 2020-09-25 | 清华大学 | 载体姿态测量方法及装置 |
WO2021020048A1 (ja) * | 2019-08-01 | 2021-02-04 | 古野電気株式会社 | 姿勢計測装置、姿勢計測方法、および、姿勢計測プログラム |
CN112859139A (zh) * | 2019-11-28 | 2021-05-28 | 中移物联网有限公司 | 一种姿态测量方法、装置及电子设备 |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107272039B (zh) * | 2017-06-07 | 2019-10-25 | 重庆重邮汇测通信技术有限公司 | 一种基于双天线gps的定位测姿方法 |
EP3734330A4 (en) * | 2017-12-01 | 2021-11-03 | Furuno Electric Co., Ltd. | OSCILLATION OBSERVATION DEVICE, METHOD AND PROGRAM |
CN109443349A (zh) * | 2018-11-14 | 2019-03-08 | 广州中海达定位技术有限公司 | 一种姿态航向测量系统及其融合方法、存储介质 |
CN110220474B (zh) * | 2019-04-30 | 2021-05-18 | 浙江华东工程安全技术有限公司 | 移动式激光扫描系统事后姿态角校正方法 |
CN110554373B (zh) * | 2019-08-25 | 2022-11-15 | 中国科学院国家授时中心 | 干涉时间测量与测距方法 |
CN112325842B (zh) * | 2020-10-30 | 2022-07-01 | 中国电子科技集团公司第五十四研究所 | 一种多天线平面投影加权测姿方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002054946A (ja) * | 2000-06-01 | 2002-02-20 | Furuno Electric Co Ltd | 物体の姿勢検出装置および整数バイアス再決定方法 |
JP2004309134A (ja) * | 2003-04-01 | 2004-11-04 | Denso Corp | 方位検出装置および方位検出システム |
JP2005106563A (ja) * | 2003-09-30 | 2005-04-21 | Mitsubishi Electric Corp | 測位装置 |
JP2006023167A (ja) * | 2004-07-07 | 2006-01-26 | National Institute Of Information & Communication Technology | 3次元配置型gps受信機、それを用いた姿勢測定方法及びシステム |
JP2007101484A (ja) * | 2005-10-07 | 2007-04-19 | Furuno Electric Co Ltd | キャリア位相相対測位装置 |
JP2008216062A (ja) * | 2007-03-05 | 2008-09-18 | Japan Radio Co Ltd | 移動体姿勢計測装置 |
JP2013507620A (ja) * | 2009-10-15 | 2013-03-04 | ノヴァテル インコーポレイテッド | 短基線位相マップ及び超短基線位相マップ |
Family Cites Families (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5506588A (en) * | 1993-06-18 | 1996-04-09 | Adroit Systems, Inc. | Attitude determining system for use with global positioning system, and laser range finder |
US5452077A (en) * | 1993-12-09 | 1995-09-19 | Hughes Aircraft Company | Transient-free method of determining satellite attitude |
US6421003B1 (en) * | 2000-05-19 | 2002-07-16 | Sri International | Attitude determination using multiple baselines in a navigational positioning system |
AU775676B2 (en) | 2000-06-01 | 2004-08-12 | Furuno Electric Company, Limited | System for determining the heading and/or attitude of a body |
JP2003232845A (ja) * | 2002-02-12 | 2003-08-22 | Furuno Electric Co Ltd | 移動体の方位および姿勢検出装置 |
US7454290B2 (en) * | 2003-09-18 | 2008-11-18 | The Board Of Trustees Of The Leland Stanford Junior University | GPS/INS vehicle attitude system |
US7292185B2 (en) * | 2005-10-04 | 2007-11-06 | Csi Wireless Inc. | Attitude determination exploiting geometry constraints |
JP2008014721A (ja) | 2006-07-04 | 2008-01-24 | Hitachi Industrial Equipment Systems Co Ltd | 姿勢算出装置、および、姿勢算出方法 |
AU2012313331A1 (en) * | 2011-09-19 | 2014-04-03 | Curtin University Of Technology | A method of estimating a quantity associated with a receiver system |
GB201200478D0 (en) * | 2011-12-30 | 2012-02-22 | Agco Corp | Coarse attitude determination from gnss antenna gain profiling |
US9529093B2 (en) * | 2012-10-12 | 2016-12-27 | Google Inc. | Systems and methods for estimating attitude using double differenced GPS carrier phase measurements |
CN102998690B (zh) * | 2012-11-26 | 2014-04-16 | 哈尔滨工程大学 | 一种基于gps载波双差方程的姿态角直接求解方法 |
JP2014145613A (ja) * | 2013-01-28 | 2014-08-14 | Furuno Electric Co Ltd | 移動体角速度推定装置、移動体速度算出装置、移動体、移動体角速度推定方法、移動体速度算出方法、移動体角速度推定プログラム、および移動体速度算出プログラム |
US20140244210A1 (en) * | 2013-02-28 | 2014-08-28 | Philip Thomas Cobbin | System and method for real time determination of 3 axis orientation from reference vectors with vector misalignment estimation |
-
2015
- 2015-11-26 WO PCT/JP2015/083153 patent/WO2016104032A1/ja active Application Filing
- 2015-11-26 EP EP15872601.8A patent/EP3239740A4/en not_active Withdrawn
- 2015-11-26 JP JP2016566053A patent/JP6470314B2/ja active Active
- 2015-11-26 CN CN201580071014.5A patent/CN107110979B/zh active Active
- 2015-11-26 US US15/540,023 patent/US10514469B2/en active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002054946A (ja) * | 2000-06-01 | 2002-02-20 | Furuno Electric Co Ltd | 物体の姿勢検出装置および整数バイアス再決定方法 |
JP2004309134A (ja) * | 2003-04-01 | 2004-11-04 | Denso Corp | 方位検出装置および方位検出システム |
JP2005106563A (ja) * | 2003-09-30 | 2005-04-21 | Mitsubishi Electric Corp | 測位装置 |
JP2006023167A (ja) * | 2004-07-07 | 2006-01-26 | National Institute Of Information & Communication Technology | 3次元配置型gps受信機、それを用いた姿勢測定方法及びシステム |
JP2007101484A (ja) * | 2005-10-07 | 2007-04-19 | Furuno Electric Co Ltd | キャリア位相相対測位装置 |
JP2008216062A (ja) * | 2007-03-05 | 2008-09-18 | Japan Radio Co Ltd | 移動体姿勢計測装置 |
JP2013507620A (ja) * | 2009-10-15 | 2013-03-04 | ノヴァテル インコーポレイテッド | 短基線位相マップ及び超短基線位相マップ |
Non-Patent Citations (1)
Title |
---|
See also references of EP3239740A4 * |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2018135187A1 (ja) * | 2017-01-17 | 2018-07-26 | 古野電気株式会社 | 方位角算出装置、方位角算出方法、および方位角算出プログラム |
WO2021020048A1 (ja) * | 2019-08-01 | 2021-02-04 | 古野電気株式会社 | 姿勢計測装置、姿勢計測方法、および、姿勢計測プログラム |
JPWO2021020048A1 (ja) * | 2019-08-01 | 2021-02-04 | ||
JP7449938B2 (ja) | 2019-08-01 | 2024-03-14 | 古野電気株式会社 | 姿勢計測装置、姿勢計測方法、および、姿勢計測プログラム |
CN112859139A (zh) * | 2019-11-28 | 2021-05-28 | 中移物联网有限公司 | 一种姿态测量方法、装置及电子设备 |
CN112859139B (zh) * | 2019-11-28 | 2023-09-05 | 中移物联网有限公司 | 一种姿态测量方法、装置及电子设备 |
CN111708069A (zh) * | 2020-07-01 | 2020-09-25 | 清华大学 | 载体姿态测量方法及装置 |
CN111708069B (zh) * | 2020-07-01 | 2021-09-21 | 清华大学 | 载体姿态测量方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
US10514469B2 (en) | 2019-12-24 |
CN107110979B (zh) | 2020-10-30 |
JP6470314B2 (ja) | 2019-02-13 |
EP3239740A4 (en) | 2018-09-26 |
EP3239740A1 (en) | 2017-11-01 |
US20170363749A1 (en) | 2017-12-21 |
CN107110979A (zh) | 2017-08-29 |
JPWO2016104032A1 (ja) | 2017-09-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6470314B2 (ja) | 姿勢角算出装置、姿勢角算出方法、および姿勢角算出プログラム | |
JP6310202B2 (ja) | 状態算出装置、移動体、状態算出方法、および状態算出プログラム | |
CN106990424B (zh) | 一种双天线gps测姿方法 | |
US9791278B2 (en) | Navigating with star tracking sensors | |
JP6360199B2 (ja) | 状態算出装置、状態算出方法、および状態算出プログラム | |
EP2972495B1 (en) | System and method for augmenting a gnss/ins navigation system of a low dynamic vessel using a vision system | |
EP3040680B1 (en) | Magnetic anomaly tracking for an inertial navigation system | |
KR20130068399A (ko) | 레이더 시스템의 오차 보정 장치 및 방법 | |
US10948292B2 (en) | Sensor error calculating device, attitude angle calculating apparatus, method of calculating sensor error and method of calculating attitude angle | |
US9423506B2 (en) | Tactical differential GPS | |
Giorgi | Attitude determination | |
Zhang et al. | RETRACTED: An improved RISS-GPS ship navigation approach via azimuth updates and magnetometer-calibration technology | |
CN112424567B (zh) | 用于辅助导航的方法 | |
WO2020110996A1 (ja) | 測位装置、速度測定装置、及びプログラム | |
WO2024180582A1 (ja) | 位置姿勢標定装置、位置姿勢標定方法、及び位置姿勢標定プログラム | |
Zhang et al. | Robot navigation using a DR/GPS data fusion | |
RU2570358C1 (ru) | Отказоустойчивая интегрированная навигационная система с избыточным количеством измерителей угловой скорости | |
CN118067153A (zh) | 一种组合导航装置测量误差的估计方法、装置及存储介质 | |
CN116878500A (zh) | 一种车辆实时运动姿态高精度检测方法 | |
Aulitzky et al. | Stand-Alone Ship-Relative Navigation System Based on Pseudolite Technology | |
JP2012198068A (ja) | 方位測定装置 | |
Prasad et al. | GPS BASED WARNING SYSTEMS FOR AIRCRAFT |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 15872601 Country of ref document: EP Kind code of ref document: A1 |
|
ENP | Entry into the national phase |
Ref document number: 2016566053 Country of ref document: JP Kind code of ref document: A |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
WWE | Wipo information: entry into national phase |
Ref document number: 15540023 Country of ref document: US |
|
REEP | Request for entry into the european phase |
Ref document number: 2015872601 Country of ref document: EP |