WO2019003758A1 - 航跡予測装置、航跡予測方法、および、航跡予測プログラム - Google Patents

航跡予測装置、航跡予測方法、および、航跡予測プログラム Download PDF

Info

Publication number
WO2019003758A1
WO2019003758A1 PCT/JP2018/020513 JP2018020513W WO2019003758A1 WO 2019003758 A1 WO2019003758 A1 WO 2019003758A1 JP 2018020513 W JP2018020513 W JP 2018020513W WO 2019003758 A1 WO2019003758 A1 WO 2019003758A1
Authority
WO
WIPO (PCT)
Prior art keywords
track prediction
angular velocity
calculation unit
track
predicted
Prior art date
Application number
PCT/JP2018/020513
Other languages
English (en)
French (fr)
Inventor
中村　拓
戸田　裕行
奈緒美 藤澤
明大 肥野
Original Assignee
古野電気株式会社
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 古野電気株式会社 filed Critical 古野電気株式会社
Priority to CN201880041335.4A priority Critical patent/CN110832342A/zh
Priority to EP18825136.7A priority patent/EP3647817A4/en
Priority to JP2019526709A priority patent/JP6808835B2/ja
Publication of WO2019003758A1 publication Critical patent/WO2019003758A1/ja
Priority to US16/728,420 priority patent/US11255675B2/en

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42—Determining position
    • G01S19/48—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
    • G01S19/49—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system whereby the further system is an inertial position system, e.g. loosely-coupled
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
    • G01P3/00—Measuring linear or angular speed; Measuring differences of linear or angular speeds
    • G01P3/42—Devices characterised by the use of electric or magnetic means
    • G01P3/44—Devices characterised by the use of electric or magnetic means for measuring angular speed
    • 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
    • G01S15/00—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
    • G01S15/02—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems using reflection of acoustic waves
    • G01S15/50—Systems of measurement, based on relative movement of the target
    • G01S15/58—Velocity or trajectory determination systems; Sense-of-movement determination systems
    • G01S15/60—Velocity or trajectory determination systems; Sense-of-movement determination systems wherein the transmitter and receiver are mounted on the moving object, e.g. for determining ground speed, drift angle, ground track
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42—Determining position
    • G01S19/421—Determining position by combining or switching between position solutions or signals derived from different satellite radio beacon positioning systems; by combining or switching between position solutions or signals derived from different modes of operation in a single system
    • G01S19/426—Determining position by combining or switching between position solutions or signals derived from different satellite radio beacon positioning systems; by combining or switching between position solutions or signals derived from different modes of operation in a single system by combining or switching between position solutions or signals derived from different modes of operation in a single system
    • 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

Definitions

  • the present invention relates to a track prediction apparatus, a track prediction method, and a track prediction program for predicting the movement position of a mobile body.
  • the conventional navigation device calculates the distance by multiplying the time from the current time to the predicted time to the current speed.
  • the conventional navigation device calculates the predicted position by adding the calculated distance to the current position.
  • the conventional navigation device calculates the predicted track by sequentially repeating the calculation of the predicted position.
  • the navigation device (display device for ships) described in Patent Document 1 further calculates a predicted position using double integration of acceleration.
  • an object of the present invention is to provide a track prediction device, a track prediction method, and a track prediction program for calculating a predicted position with high accuracy.
  • a track prediction device includes a horizontal ground speed calculation unit, an angular velocity calculation unit, and a predicted position calculation unit.
  • the horizontal ground speed calculation unit calculates the horizontal ground speed from the attitude angle of the moving body, the ground course, and the ground boat speed.
  • the angular velocity calculation unit measures or calculates the angular velocity of the moving body.
  • the predicted position calculation unit calculates the predicted position using the time from the current time to the predicted time and the horizontal ground speed, and using the integration calculation of the angular velocity if the angular velocity exceeds the rotation detection threshold.
  • the predicted position is calculated using the integral value of the acquired angular velocity when the moving body is performing rotational movement.
  • the predicted position can be calculated with high accuracy.
  • 5 is a flowchart of track prediction according to an embodiment of the present invention. It is a flow chart of calculation of anticipation position concerning an embodiment of the present invention. It is a block of the track forecasting device concerning a 2nd embodiment of the present invention.
  • a track prediction device, a track prediction method, and a track prediction program according to a first embodiment of the present invention will be described with reference to the drawings.
  • the structure of this invention is applicable also on other water, an underwater moving body, a land moving body, or an airborne moving body.
  • FIG. 1 is a block of a track prediction apparatus according to a first embodiment of the present invention.
  • FIG. 2 is a diagram for explaining the concept of calculating a predicted position according to the first embodiment of this invention.
  • the track prediction device 10 includes a current position calculation unit 20, an angular velocity calculation unit 30, an attitude angle calculation unit 40, a ground course calculation unit 50, a ground ship speed calculation unit 60, a horizontal ground speed calculation unit 70, And a predicted position calculation unit 80.
  • the current position calculation unit 20 calculates the current position P of the moving object equipped with the track prediction device 10.
  • the current position P (0) has a latitude component Plat (0) and a longitude component Plon (0).
  • the current position calculation unit 20 calculates the current position Pec (0) of the ECEF orthogonal coordinate system using, for example, the code pseudo distance of the positioning signal.
  • the current position calculation unit 20 calculates the current position Pec (0) using a positioning signal received by at least one antenna mounted on the hull.
  • the current position calculation unit 20 converts the current position Pec (0) of the ECEF orthogonal coordinate system to the current position P of the ENU coordinate system using a coordinate conversion matrix of the ECEF orthogonal coordinate system and the ENU coordinate system, and the current position The latitude component Plat (0) of P and the longitude component Plon (0) are calculated.
  • the current position calculation unit 20 outputs the current position P (0) to the predicted position calculation unit 80.
  • the angular velocity calculation unit 30 calculates the angular velocity ⁇ (t) of the hull.
  • the angular velocity calculation unit 30 is, for example, a gyro sensor or the like that is an inertial sensor, and measures and outputs an angular velocity ⁇ (t).
  • the angular velocity calculation unit 30 calculates an angular velocity ⁇ using the carrier wave phase difference of the positioning signal.
  • the angular velocity calculation unit 30 calculates the angular velocity ⁇ (t) using the difference between the carrier wave phases received by at least two antennas disposed at different positions of the moving body.
  • the angular velocity calculation unit 30 outputs the angular velocity ⁇ (t) to the predicted position calculation unit 80.
  • the attitude angle calculation unit 40 calculates the attitude angle of the hull.
  • the attitude angle is usually composed of a pitch angle ⁇ (t), a roll angle ⁇ (t), and a yaw angle ⁇ (t).
  • the attitude angle calculation unit 40 calculates at least the yaw angle ⁇ (t).
  • the attitude angle calculation unit 40 calculates an attitude angle including at least the yaw angle ⁇ (t) using the angular velocity calculation unit 30 and the measurement value of the inertial sensor or the carrier wave phase difference.
  • the attitude angle calculation unit 40 may calculate the yaw angle ⁇ (t) from the angular velocity calculated by the angular velocity calculation unit 30. By using the carrier wave phase, a highly accurate attitude angle can be obtained with a simple configuration.
  • the ground route calculation unit 50 calculates the ground route COG (t) using the attitude angle of the hull and the like.
  • the ground route calculation unit 50 outputs the ground route COG (t) to the horizontal ground speed calculation unit 70.
  • the ground ship speed calculation unit 60 calculates the ground ship speed SOG (t) using the output of the Doppler sonar or the like.
  • the ground ship speed calculation unit 60 outputs the ground ship speed SOG (t) to the horizontal ground speed calculation unit 70.
  • the horizontal ground speed calculation unit 70 calculates the horizontal ground speed Vb (t) of the ship coordinate system using the method described below.
  • the horizontal ground speed Vb (t) is a vector quantity, and is composed of an x-direction component Vbx (t) and a y-direction component Vby (t).
  • the x direction is a component parallel to the bow direction of the ship 100 as shown in FIG. 2, and the direction from the stern to the bow is a positive direction.
  • the y direction is orthogonal to the bow direction (x direction), and the direction from the port side to the starboard side is a positive direction.
  • the x-direction component Vbx (t) and the y-direction component Vby (t) of the horizontal ground velocity Vb (t) are obtained from the following equations as the deflection angle ⁇ (t).
  • Vbx (t) SOG (t) ⁇ cos ⁇ (t)-(Expression 1)
  • Vby (t) SOG (t) ⁇ sin ⁇ (t)-(equation 2)
  • the declination angle ⁇ is obtained by the following equation from the ground path COG and the yaw angle ⁇ .
  • the horizontal ground speed calculation unit 70 calculates the horizontal ground speed Vn (t) of the ENU coordinate system using the following equation.
  • the horizontal ground velocity Vn (t) in the ENU coordinate system (NED coordinate system) and the horizontal ground velocity Vb (t) in the ship coordinate system have a yaw angle ⁇ (t) in two coordinate systems. It is in the relation of the angle of Therefore, the north direction component VnN (t) of the horizontal to ground velocity Vn (t) in the ENU coordinate system (NED coordinate system) and the east direction component VnE (t) are x of the horizontal ground velocity Vb (t) of the ship coordinate system. It is calculated from the directional component Vbx (t), the y-directional component Vby (t), and the yaw angle ⁇ (t).
  • Vn N (t) Vbx (t) ⁇ cos ⁇ (t)-Vby (t) ⁇ sin ⁇ (t) -(Equation 4)
  • VnE (t) Vbx (t) ⁇ sin ⁇ (t) + Vby (t) ⁇ cos ⁇ (t) -(Equation 5)
  • the predicted position calculation unit 80 calculates the predicted position P ( ⁇ ) of the predicted time ⁇ using the following method.
  • the predicted position calculation unit 80 determines whether the ship 100 is in translational motion or rotational motion from the angular velocity ⁇ .
  • the prediction position calculation unit 80 performs prediction using the integral calculation of the prediction positions (Expression 6) and (Expression 7) during rotational movement, that is, when the yaw angle ⁇ ( ⁇ ) exceeds the rotation detection threshold.
  • the position P ( ⁇ ) (Plat ( ⁇ ), Plon ( ⁇ )) is calculated.
  • the predicted position calculation unit 80 calculates the predicted position P ( ⁇ ) using an operation including an integral value of an angular velocity which is an acceleration in the turning direction.
  • the predicted position calculation unit 80 uses the next calculation that does not use the acceleration (angular velocity) to calculate the predicted position P (translational movement), ie, when the yaw angle ⁇ ( ⁇ ) is less than the rotation detection threshold. Calculate ⁇ ).
  • the track prediction device 10 can suppress the use of the unnecessary acceleration term for the calculation of the predicted position P ( ⁇ ) according to the behavior of the ship 100. Thereby, the increase of the error by using the said acceleration term is suppressed. Therefore, the track prediction device 10 can calculate the predicted position P ( ⁇ ) with high accuracy. Furthermore, if there is position information (hull coordinates from the center of gravity position) of the inertial sensor such as a velocity sensor or angular velocity sensor, the attitude angle of the hull is corrected to the gravity center position of the hull, and the predicted position P ( ⁇ ) is made higher. It can be calculated to the accuracy.
  • position information hull coordinates from the center of gravity position
  • the inertial sensor such as a velocity sensor or angular velocity sensor
  • FIG. 3 is a diagram simulating track prediction results of the track prediction apparatus of the present embodiment and the track prediction apparatus of the comparative example.
  • FIG. 3 (A) shows a predicted track using the configuration of the present application
  • FIG. 3 (B) shows a predicted track always using the speed and the variation of the speed
  • FIG. 3 (C) shows only the speed
  • FIG. 3 (D) shows a predicted track using speed and acceleration at all times.
  • a dotted line shows an actual track
  • a solid line shows a predicted track.
  • FIG. 3 (A), FIG. 3 (B), FIG. 3 (C) and FIG. 3 (D) by using the configuration of the track prediction device 10 in the present embodiment, the actual track and the predicted track The difference can be reduced.
  • FIG. 4 is a diagram showing standard deviations of predicted tracks with respect to actual tracks of the track prediction apparatus of the present embodiment and the track prediction apparatus of the comparative example.
  • FIG. 4 (A) shows the standard deviation of the predicted track in latitude
  • FIG. 4 (B) shows the standard deviation of the predicted track in longitude.
  • the solid line is the standard deviation of the predicted track of the present application
  • the dotted line is the standard deviation of the predicted track using only velocity
  • the alternate long and short dash line is the velocity and speed.
  • the variation amount is a standard deviation of a predicted track always used
  • a two-dot chain line is a standard deviation of a predicted track always using velocity and acceleration.
  • the standard deviation of the predicted track is reduced by using the configuration of the track prediction apparatus 10 in this embodiment. it can. That is, the error of the predicted track with respect to the actual track can be reduced.
  • achieves the process performed with the track prediction apparatus 10 by several function part was shown.
  • the plurality of processes described above may be programmed and stored in a storage medium, and the program may be read and executed by an arithmetic processing unit such as a computer.
  • the arithmetic processing unit may execute the processing according to the flowcharts shown in FIG. 5 and FIG.
  • FIG. 5 is a flowchart of track prediction according to an embodiment of the present invention.
  • FIG. 6 is a flowchart of calculation of a predicted position according to an embodiment of the present invention.
  • the specific realization method of each process is the same as the process of each above-mentioned function part, it abbreviate
  • the arithmetic processor calculates the current position P (0) (S11).
  • the arithmetic processor calculates an angular velocity ⁇ (t).
  • the arithmetic processor calculates the horizontal ground speed Vn using the yaw angle ⁇ (t) of the attitude angle, the ground course COG (t), and the ground ship speed SOG (t) (S13).
  • the arithmetic processor calculates the predicted position P ( ⁇ ) using the current position P (0), the angular velocity ⁇ , and the horizontal ground velocity Vn ( ⁇ ) at the predicted time ⁇ .
  • the arithmetic processor detects that the angular velocity ⁇ is approximately 0, ie, less than the rotation detection threshold (S41: YES)
  • the arithmetic processor does not use the acceleration.
  • the predicted position P ( ⁇ ) is calculated (S42).
  • the arithmetic processor detects that the angular velocity ⁇ is significantly different from 0, that is, exceeds the rotation detection threshold (S41: NO)
  • the arithmetic processor predicts by integral calculation using the angular velocity which is the acceleration in the gyrus direction.
  • the position P ( ⁇ ) is calculated (S43).
  • FIG. 7 is a block of a track prediction device according to a second embodiment of the present invention.
  • the track prediction apparatus 10A according to the second embodiment of the present invention differs from the track prediction apparatus 10 according to the first embodiment in that a display 90 is added.
  • the other configuration of the track prediction device 10A is the same as that of the track prediction device 10, and the description of the same parts will be omitted.
  • the predicted position calculation unit 80 outputs the calculated predicted position to the display 90.
  • the display 90 displays this predicted position.
  • the predicted position calculation unit 80 calculates a predicted track
  • the predicted position calculation unit 80 outputs the predicted track to the display 90.
  • the display 90 displays the predicted track.
  • the attitude angle calculation unit 40, the ground course calculation unit 50, and the ground ship speed calculation unit 60 may be separate from the above-described track prediction devices 10 and 10A. Furthermore, the current position calculation unit 20 and the angular velocity calculation unit 30 may be separate from the track prediction device 10, 10A.

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Automation & Control Theory (AREA)
  • Acoustics & Sound (AREA)
  • Navigation (AREA)
  • Traffic Control Systems (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)
  • Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)

Abstract

【課題】予測位置を高精度に算出する。 【解決手段】航跡予測装置１０は、角速度算出部３０、水平対地速度算出部７０、および、予測位置算出部８０を備える。角速度算出部３０は、移動体の角速度を計測または算出する。水平対地速度算出部７０は、移動体の姿勢角、対地進路、および、対地船速から水平対地速度を算出する。予測位置算出部８０は、現在時刻から予測先時刻までの時間と水平対地速度とを用い、角速度が回動検出閾値を超えていれば角速度の積分演算を用いて予測位置を算出する。

Description

航跡予測装置、航跡予測方法、および、航跡予測プログラム
　本発明は、移動体の移動位置を予測する航跡予測装置、航跡予測方法、および、航跡予測プログラムに関する。
　従来、予測航跡を表示する機能を有する航法装置が各種考案され、実用化されている。従来の航法装置は、現在時刻から予測先時刻迄の時間に、現在の速度を乗じることで距離を算出する。従来の航法装置は、この算出した距離を現在位置に加算することで、予測位置を算出する。そして、従来の航法装置は、この予測位置の算出を順次繰り返すことによって、予測航跡を算出する。
　このような航法装置として、特許文献１に記載の航法装置（船舶用表示装置）は、さらに、加速度の二重積分を用いて、予測位置を算出している。
特許第０４２８６３６号明細書
　しかしながら、特許文献１に記載の航法装置では、時間の２乗の１／２乗値に、加速度を乗じた値を用いるため、加速度の観測誤差等によるノイズ成分が増大してしまう。これにより、予測位置および予測航跡の誤差が大きくなってしまう。
　したがって、本発明の目的は、予測位置を高精度に算出する航跡予測装置、航跡予測方法、および、航跡予測プログラムを提供することにある。
　この発明の航跡予測装置は、水平対地速度算出部、角速度算出部、および、予測位置算出部を備える。水平対地速度算出部は、移動体の姿勢角、対地進路、および、対地船速から水平対地速度を算出する。角速度算出部は、移動体の角速度を計測または算出する。予測位置算出部は、現在時刻から予測先時刻までの時間と水平対地速度とを用い、角速度が回動検出閾値を超えていれば角速度の積分演算を用いて予測位置を算出する。
　この構成では、予測位置は、移動体が回転運動を行っている時には、取得された角速度の積分値を用いて算出される。
　この発明によれば、予測位置を高精度に算出できる。
本発明の第１の実施形態に係る航跡予測装置のブロックである。 本発明の第１の実施形態の予測位置の算出概念を説明するための図である。 本実施形態の航跡予測装置と比較例の航跡予測装置との航跡予測結果をシミュレーションした図である。 本実施形態の航跡予測装置と比較例の航跡予測装置との実航跡に対する予測航跡の標準偏差を示した図である。 本発明の実施形態に係る航跡予測のフローチャートである。 本発明の実施形態に係る予測位置の算出のフローチャートである。 本発明の第２の実施形態に係る航跡予測装置のブロックである。
　本発明の第１の実施形態に係る航跡予測装置、航跡予測方法、および、航跡予測プログラムについて、図を参照して説明する。なお、以下では、移動体として船舶を用いる態様を示すが、他の水上、水中移動体、陸上移動体、または、空中移動体にも、本願発明の構成は適用できる。
　図１は、本発明の第１の実施形態に係る航跡予測装置のブロックである。図２は、本発明の第１の実施形態の予測位置の算出概念を説明するための図である。
　図１に示すように、航跡予測装置１０は、現在位置算出部２０、角速度算出部３０、姿勢角算出部４０、対地進路算出部５０、対地船速算出部６０、水平対地速度算出部７０、および、予測位置算出部８０を備える。
　現在位置算出部２０は、航跡予測装置１０が装備される移動体の現在位置Ｐを算出する。現在位置Ｐ（０）は、緯度成分Ｐｌａｔ（０）と経度成分Ｐｌｏｎ（０）とを有する。現在位置算出部２０は、例えば、測位信号のコード擬似距離等を用いて、ＥＣＥＦ直交座標系の現在位置Ｐｅｃ（０）を算出する。現在位置算出部２０は、船体に装着された少なくとも１個のアンテナで受信した測位信号を用いて、現在位置Ｐｅｃ（０）を算出する。現在位置算出部２０は、ＥＣＥＦ直交座標系とＥＮＵ座標系との座標変換行列を用いて、ＥＣＥＦ直交座標系の現在位置Ｐｅｃ（０）を、ＥＮＵ座標系の現在位置Ｐに変換し、現在位置Ｐの緯度成分Ｐｌａｔ（０）と経度成分Ｐｌｏｎ（０）とを算出する。現在位置算出部２０は、現在位置Ｐ（０）を、予測位置算出部８０に出力する。
　角速度算出部３０は、船体の角速度ω（ｔ）を算出する。角速度算出部３０は、一例として、慣性センサであるジャイロセンサ等であり、角速度ω（ｔ）を計測して出力する。角速度算出部３０は、また別の一例として、測位信号の搬送波位相差を用いて角速度ωを算出する。この場合、角速度算出部３０は、移動体の異なる位置に配置された少なくとも２個のアンテナで受信した搬送波位相の差を用いて、角速度ω（ｔ）を算出する。角速度算出部３０は、角速度ω（ｔ）を、予測位置算出部８０に出力する。搬送波位相を用いることによって、簡素な構成で、高精度な角速度が得られる。
　姿勢角算出部４０は、船体の姿勢角を算出する。姿勢角は、通常、ピッチ角φ（ｔ）、ロール角θ（ｔ）、および、ヨー角ψ（ｔ）で構成されている。姿勢角算出部４０は、少なくともヨー角ψ（ｔ）を算出する。姿勢角算出部４０は、角速度算出部３０と、慣性センサの計測値または搬送波位相差を用いて、少なくともヨー角ψ（ｔ）を含む姿勢角を算出する。なお、姿勢角算出部４０は、角速度算出部３０で算出された角速度からヨー角ψ（ｔ）を算出してもよい。搬送波位相を用いることによって、簡素な構成で、高精度な姿勢角が得られる。
　対地進路算出部５０は、船体の姿勢角等を用いて、対地進路ＣＯＧ（ｔ）を算出する。対地進路算出部５０は、対地進路ＣＯＧ（ｔ）を、水平対地速度算出部７０に出力する。
　対地船速算出部６０は、ドップラソナーの出力等を用いて、対地船速ＳＯＧ（ｔ）を算出する。対地船速算出部６０は、対地船速ＳＯＧ（ｔ）を、水平対地速度算出部７０に出力する。
　水平対地速度算出部７０は、次に示す方法を用いて、船体座標系の水平対地速度Ｖｂ（ｔ）を算出する。水平対地速度Ｖｂ（ｔ）は、ベクトル量であり、ｘ方向成分Ｖｂｘ（ｔ）と、ｙ方向成分Ｖｂｙ（ｔ）とから構成されている。ｘ方向とは、図２に示すように船舶１００の船首方向に平行な成分であり、船尾から船首に向く方向を正方向とする。ｙ方向とは、船首方向（ｘ方向）に直交し、左舷から右舷に向く方向を正の方向とする。
　図２に示すように、水平対地速度Ｖｂ（ｔ）のｘ方向成分Ｖｂｘ（ｔ）とｙ方向成分Ｖｂｙ（ｔ）とは、偏角β（ｔ）として、次式から得られる。
　Ｖｂｘ（ｔ）＝ＳＯＧ（ｔ）・ｃｏｓβ（ｔ）　　　　－（式１）
　Ｖｂｙ（ｔ）＝ＳＯＧ（ｔ）・ｓｉｎβ（ｔ）　　　　－（式２）
　ここで、偏角βは、対地進路ＣＯＧとヨー角ψから次式で得られる。
　β（ｔ）＝ＣＯＧ（ｔ）－ψ（ｔ）　　　　－（式３）
　水平対地速度算出部７０は、次式を用いて、ＥＮＵ座標系の水平対地速度Ｖｎ（ｔ）を算出する。
　図２に示すように、ＥＮＵ座標系（ＮＥＤ座標系）の水平対地速度Ｖｎ（ｔ）と船体座標系の水平対地速度Ｖｂ（ｔ）とは、ヨー角ψ（ｔ）を２個の座標系の成す角とする関係にある。したがって、ＥＮＵ座標系（ＮＥＤ座標系）の水平対地速度Ｖｎ（ｔ）のノース方向成分ＶｎＮ（ｔ）とイースト方向成分ＶｎＥ（ｔ）とは、船体座標系の水平対地速度Ｖｂ（ｔ）のｘ方向成分Ｖｂｘ（ｔ）とｙ方向成分Ｖｂｙ（ｔ）、および、ヨー角ψ（ｔ）から算出される。
　ＶｎＮ（ｔ）＝Ｖｂｘ（ｔ）・ｃｏｓψ（ｔ）－Ｖｂｙ（ｔ）・ｓｉｎψ（ｔ）
　　　　　　　　　　　　　　　　　　　　　　　　　　　　　　　　　－（式４）
　ＶｎＥ（ｔ）＝Ｖｂｘ（ｔ）・ｓｉｎψ（ｔ）＋Ｖｂｙ（ｔ）・ｃｏｓψ（ｔ）
　　　　　　　　　　　　　　　　　　　　　　　　　　　　　　　　　－（式５）
　水平対地速度算出部７０は、ＥＮＵ座標系の水平対地速度Ｖｎ（ｔ）＝（ＶｎＮ（ｔ）、ＶｎＥ（ｔ））を、予測位置算出部８０に出力する。
　予測位置算出部８０は、次の方法を用いて、予測時刻τの予測位置Ｐ（τ）を算出する。
　時刻ｔにおいて、予測位置Ｐ（ｔ）＝（Ｐｌａｔ（ｔ）、Ｐｌｏｎ（ｔ））と、水平対地速度Ｖｎ（ｔ）＝（ＶｎＮ（ｔ）、ＶｎＥ（ｔ））との間には、以下の関係が成り立つ。
　ｄＰｌａｔ（ｔ）／ｄｔ＝ＶｎＮ（ｔ）　　　　－（式６）
　ｄＰｌｏｎ（ｔ）／ｄｔ＝ＶｎＥ（ｔ）　　　　－（式７）
　また、予測時刻のヨー角ψ（τ）は、初期時刻のヨー角ψ（０）と、初期時刻ｔ＝０から予測時刻ｔ＝τまでの角速度ω（ｔ）の積分演算とを用いて得られる。船舶１００が定常旋回すると想定すると、初期時刻ｔ＝０から予測時刻ｔ＝τまで、ω（ｔ）は一定値ωとなる。したがって、予測時刻のヨー角ψ（τ）は次式で得られる。
　ψ（τ）＝ψ（０）＋ω・τ　　　　－（式８）
　また、予測位置算出部８０は、角速度ωから、船舶１００が並進運動中か回転運動中かを判断する。予測位置算出部８０は、それぞれの場合に応じて、Ｐ（τ）＝（Ｐｌａｔ（τ）、Ｐｌｏｎ（τ））を算出する。
　予測位置算出部８０は、回転運動中、すなわち、ヨー角ψ（τ）が、回動検出閾値を超えていれば、予測位置（式６）、（式７）の積分演算を用いて、予測位置Ｐ（τ）＝（Ｐｌａｔ（τ）、Ｐｌｏｎ（τ））を算出する。
　Ｐｌａｔ（τ）＝Ｐｌａｔ（０）＋（積分演算（ＶｎＮ））
　　　　　　　　＝Ｐｌａｔ（０）＋（ＶｎＮ（０）・ｓｉｎωτ）／ω－（ＶｎＥ（０）・（１－ｃｏｓωτ））／ω　　　　－（式９）
　Ｐｌｏｎ（τ）＝Ｐｌｏｎ（０）＋（積分演算（ＶｎＥ））
　　　　　　　　＝Ｐｌｏｎ（０）＋（ＶｎＮ（０）・（１－ｃｏｓωτ））／ω－（ＶｎＥ（０）・ｓｉｎωτ）／ω　　　　－（式１０）
　すなわち、予測位置算出部８０は、船舶１００が回転運動中であれば、回頭方向の加速度である角速度の積分値を含む演算を用いて、予測位置Ｐ（τ）を算出する。
　一方、予測位置算出部８０は、並進運動中、すなわち、ヨー角ψ（τ）が、回動検出閾値以下であれば、加速度（角速度）を用いない次の演算を用いて、予測位置Ｐ（τ）を算出する。
　Ｐｌａｔ（τ）＝Ｐｌａｔ（０）＋ＶｎＮ（０）・τ　　　　－（式１１）
　Ｐｌｏｎ（τ）＝Ｐｌｏｎ（０）＋ＶｎＥ（０）・τ　　　　－（式１２）
　予測位置算出部８０は、算出した予測位置Ｐ（τ）＝（Ｐｌａｔ（τ）、Ｐｌｏｎ（τ））を出力する。また、予測位置算出部８０は、この予測位置Ｐ（τ）の算出を、継続的に実行していき、複数の時刻τでの予測位置Ｐ（τ）を算出する。そして、予測位置算出部８０は、これら複数の時刻τでの予測位置Ｐ（τ）を繋ぐことで、予測航跡を得ることができる。
　このような構成および処理を用いることによって、航跡予測装置１０は、船舶１００の挙動に応じて、予測位置Ｐ（τ）の算出への不必要な加速度項の利用を抑制できる。これにより、当該加速度項を用いることによる誤差の増加は抑制される。したがって、航跡予測装置１０は、予測位置Ｐ（τ）を高精度に算出できる。さらに、速度センサ、角速度センサ等の慣性センサの船体での位置情報（重心位置からの船体座標）があれば船体の姿勢角から船体の重心位置に補正し、予測位置Ｐ（τ）をより高精度に算出できる。
　図３は、本実施形態の航跡予測装置と比較例の航跡予測装置との航跡予測結果をシミュレーションした図である。図３（Ａ）は、本願の構成を用いた予測航跡を示し、図３（Ｂ）は、速度と速度の変化量とを常時用いた予測航跡を示し、図３（Ｃ）は、速度のみを用いた予測航跡を示し、図３（Ｄ）は、速度と加速度を常時用いた予測航跡を示す。図３（Ａ）、図３（Ｂ）、図３（Ｃ）、図３（Ｄ）において、点線は実航跡を示し、実線は予測航跡を示す。
　図３（Ａ）、図３（Ｂ）、図３（Ｃ）、図３（Ｄ）に示すように、本実施形態に航跡予測装置１０の構成を用いることで、実航跡と予測航跡との差を小さくできる。
　図４は、本実施形態の航跡予測装置と比較例の航跡予測装置との実航跡に対する予測航跡の標準偏差を示した図である。図４（Ａ）は、緯度における予測航跡の標準偏差を示し、図４（Ｂ）は、経度における予測航跡の標準偏差を示す。図４（Ａ）、図４（Ｂ）において、実線は、本願の予測航跡の標準偏差であり、点線は、速度のみを用いた予測航跡の標準偏差であり、一点鎖線は、速度と速度の変化量とを常時用いた予測航跡の標準偏差であり、二点鎖線は、速度と加速度を常時用いた予測航跡の標準偏差である。
　図４（Ａ）、図４（Ｂ）、図４（Ｃ）、図４（Ｄ）に示すように、本実施形態に航跡予測装置１０の構成を用いることで、予測航跡の標準偏差を小さくできる。すなわち、実航跡に対する予測航跡の誤差を小さくできる。
　なお、上述の説明では、航跡予測装置１０で実行する処理を複数の機能部によって実現する態様を示した。しかしながら、上述の複数の処理をプログラム化して記憶媒体に記憶しておき、コンピュータ等の演算処理器で、当該プログラムを読み出して実行してもよい。この場合、演算処理器は、図５、図６に示すフローチャートに応じた処理を実行すればよい。
　図５は、本発明の実施形態に係る航跡予測のフローチャートである。図６は、本発明の実施形態に係る予測位置の算出のフローチャートである。なお、各処理の具体的な実現方法は、上述の各機能部の処理を同じであるので、説明は省略する。
　図５に示すように、演算処理器は、現在位置Ｐ（０）を算出する（Ｓ１１）。演算処理器は、角速度ω（ｔ）を算出する。演算処理器は、姿勢角のヨー角ψ（ｔ）、対地進路ＣＯＧ（ｔ）、および、対地船速ＳＯＧ（ｔ）を用いて、水平対地速度Ｖｎを算出する（Ｓ１３）。演算処理器は、現在位置Ｐ（０）、角速度ω、および、予測時刻τの水平対地速度Ｖｎ（τ）を用いて、予測位置Ｐ（τ）を算出する。
　より具体的には、図６に示すように、演算処理器は、角速度ωが略０である、すなわち、回動検出閾値以下であることを検出すると（Ｓ４１：ＹＥＳ）、加速度を用いずに、予測位置Ｐ（τ）を算出する（Ｓ４２）。演算処理器は、角速度ωが０と大きく異なっている、すなわち、回動検出閾値を超えていることを検出すると（Ｓ４１：ＮＯ）、回頭方向の加速度である角速度を利用した積分演算で、予測位置Ｐ（τ）を算出する（Ｓ４３）。
　次に、第２の実施形態に係る航跡予測装置、航跡予測方法、および、航跡予測プログラムについて、図を参照して説明する。図７は、本発明の第２の実施形態に係る航跡予測装置のブロックである。
　図７に示すように、本発明の第２の実施形態に係る航跡予測装置１０Ａは、第１の実施形態に係る航跡予測装置１０に対して、表示器９０を追加した点において異なる。航跡予測装置１０Ａの他の構成は、航跡予測装置１０と同様であり、同様の箇所の説明は省略する。
　予測位置算出部８０は、算出した予測位置を表示器９０に出力する。表示器９０は、この予測位置を表示する。また、予測位置算出部８０は、予測航跡を算出した場合、当該予測航跡を表示器９０に出力する。表示器９０は、予測航跡を表示する。
　このような構成とすることによって，予測位置や予測航跡を、オペレータが容易に視認できる。
　なお、上述の航跡予測装置１０、１０Ａに対して、姿勢角算出部４０、対地進路算出部５０、および、対地船速算出部６０は、別体であってもよい。さらに、航跡予測装置１０、１０Ａに対して、現在位置算出部２０、および、角速度算出部３０は、別体であってもよい。
１０、１０Ａ：航跡予測装置
２０：現在位置算出部
３０：角速度算出部
４０：姿勢角算出部
５０：対地進路算出部
６０：対地船速算出部
７０：水平対地速度算出部
８０：予測位置算出部
９０：表示器
１００：船舶

Claims (20)

  1. 　移動体の姿勢角、対地進路、および、対地船速から水平対地速度を算出する水平対地速度算出部と、
    　前記移動体の角速度を計測または算出する角速度算出部と、
    　現在時刻から予測時刻までの時間と前記水平対地速度とを用い、前記角速度が前記回動検出閾値を超えていれば前記角速度の積分演算を用いて予測位置を算出する予測位置算出部と、
    　を備える、航跡予測装置。
  2. 　請求項１に記載の航跡予測装置であって、
    　前記予測位置算出部は、
    　前記角速度が回動検出閾値以下であれば前記角速度を用いずに予測位置を算出する、
    　航跡予測装置。
  3. 　請求項１または請求項２に記載の航跡予測装置であって、
    　測位信号の搬送波位相を用いて、前記姿勢角を算出する姿勢角算出部を備える、航跡予測装置。
  4. 　請求項１乃至請求項３のいずれかに記載の航跡予測装置であって、
    　測位信号の搬送波位相を用いて、前記対地進路を算出する対地進路算出部を備える、航跡予測装置。
  5. 　請求項３に記載の航跡予測装置であって、
    　前記姿勢角算出部は、前記姿勢角における少なくともヨー角を算出する、
    　航跡予測装置。
  6. 　請求項１乃至請求項５のいずれかに記載の航跡予測装置であって、
    　前記角速度算出部は、
    　測位信号の搬送波位相または慣性センサの出力を用いて前記角速度を算出する、
    　航跡予測装置。
  7. 　請求項１乃至請求項６のいずれかに記載の航跡予測装置であって、
    　前記予測位置算出部は、複数の前記予測時刻に対する予測位置を算出して、これらを繋ぐ予測航跡を算出する、
    　航跡予測装置。
  8. 　請求項７に記載の航跡予測装置であって、
    　前記予測位置と前記予測航跡とを表示する表示部を備える、
    　航跡予測装置。
  9. 　移動体の姿勢角、対地進路、および、対地船速から水平対地速度を算出し、
    　前記移動体の角速度を計測または算出し、
    　現在時刻から予測時刻までの時間と前記水平対地速度とを用い、前記角速度が前記回動検出閾値を超えていれば前記角速度の積分演算を用いて予測位置を算出する、
    　航跡予測方法。
  10. 　請求項９に記載の航跡予測方法であって、
    　前記予測位置を算出するときに、前記角速度が回動検出閾値以下であれば前記角速度を用いずに前記予測位置を算出する、
    　航跡予測方法。
  11. 　請求項９または請求項１０に記載の航跡予測方法であって、
    　測位信号の搬送波位相を用いて、前記姿勢角を算出する、
    　航跡予測方法。
  12. 　請求項９乃至請求項１１のいずれかに記載の航跡予測方法であって、
    　測位信号の搬送波位相を用いて、前記対地進路を算出する、
    　航跡予測方法。
  13. 　請求項１１に記載の航跡予測方法であって、
    　前記姿勢角を算出する際に、前記姿勢角における少なくともヨー角を算出する、
    　航跡予測方法。
  14. 　請求項９乃至請求項１３のいずれかに記載の航跡予測方法であって、
    　前記角速度を算出する際に、
    　測位信号の搬送波位相または慣性センサの出力を用いて前記角速度を算出する、
    　航跡予測方法。
  15. 　移動体の姿勢角、対地進路、および、対地船速から水平対地速度を算出し、
    　前記移動体の角速度を計測または算出し、
    　現在時刻から予測時刻までの時間と前記水平対地速度とを用い、前記角速度が前記回動検出閾値を超えていれば前記角速度の積分演算を用いて前記予測位置を算出する、
    　処理を、演算処理器に実行させる、航跡予測プログラム。
  16. 　請求項１５に記載の航跡予測プログラムであって、
    　前記予測位置を算出するときに、前記角速度が回動検出閾値以下であれば前記角速度を用いずに前記予測位置を算出する、
    　処理を、前記演算処理器に実行させる、航跡予測プログラム。
  17. 　請求項１５または請求項１６に記載の航跡予測プログラムであって、
    　測位信号の搬送波位相を用いて、前記姿勢角を算出する、
    　処理を、前記演算処理器に実行させる、航跡予測プログラム。
  18. 　請求項１５乃至請求項１７のいずれかに記載の航跡予測プログラムであって、
    　測位信号の搬送波位相を用いて、前記対地進路を算出する、
    　処理を、前記演算処理器に実行させる、航跡予測プログラム。
  19. 　請求項１７に記載の航跡予測プログラムであって、
    　前記姿勢角を算出する際に、前記姿勢角における少なくともヨー角を算出する、
    　処理を、前記演算処理器に実行させる、航跡予測プログラム。
  20. 　請求項１５乃至請求項１９のいずれかに記載の航跡予測プログラムであって、
    　前記角速度を算出する際に、
    　測位信号の搬送波位相または慣性センサの出力を用いて前記角速度を算出する、
    　処理を、前記演算処理器に実行させる、航跡予測プログラム。
PCT/JP2018/020513 2017-06-30 2018-05-29 航跡予測装置、航跡予測方法、および、航跡予測プログラム WO2019003758A1 (ja)

Priority Applications (4)

Application Number Priority Date Filing Date Title
CN201880041335.4A CN110832342A (zh) 2017-06-30 2018-05-29 航迹预测装置、航迹预测方法及航迹预测程序
EP18825136.7A EP3647817A4 (en) 2017-06-30 2018-05-29 LANE PREDICTION DEVICE, LANE PREDICTION METHOD AND LANE PREDICTION PROGRAM
JP2019526709A JP6808835B2 (ja) 2017-06-30 2018-05-29 航跡予測装置、航跡予測方法、および、航跡予測プログラム
US16/728,420 US11255675B2 (en) 2017-06-30 2019-12-27 Course estimating device, method of estimating course, and course estimating program

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2017128510 2017-06-30
JP2017-128510 2017-06-30

Related Child Applications (1)

Application Number Title Priority Date Filing Date
US16/728,420 Continuation-In-Part US11255675B2 (en) 2017-06-30 2019-12-27 Course estimating device, method of estimating course, and course estimating program

Publications (1)

Publication Number Publication Date
WO2019003758A1 true WO2019003758A1 (ja) 2019-01-03

Family

ID=64740593

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2018/020513 WO2019003758A1 (ja) 2017-06-30 2018-05-29 航跡予測装置、航跡予測方法、および、航跡予測プログラム

Country Status (5)

Country Link
US (1) US11255675B2 (ja)
EP (1) EP3647817A4 (ja)
JP (1) JP6808835B2 (ja)
CN (1) CN110832342A (ja)
WO (1) WO2019003758A1 (ja)

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS60111214U (ja) * 1983-12-29 1985-07-27 横河電機株式会社 航法装置
JPH0428636B2 (ja) 1987-07-21 1992-05-14 Kito Kk
JP2006194806A (ja) * 2005-01-17 2006-07-27 Japan Radio Co Ltd 船舶用表示装置
US20110210865A1 (en) * 2010-02-26 2011-09-01 Electronics And Telecommunications Research Institute Traffic control apparatus and method using navigation route information of vehicle for each navigational situation
JP2014145614A (ja) * 2013-01-28 2014-08-14 Furuno Electric Co Ltd 回頭角速度検出装置、移動体、回頭角速度検出方法、および、回頭角速度検出プログラム
JP2015025671A (ja) * 2013-07-24 2015-02-05 古野電気株式会社 状態算出装置、移動体、状態算出方法、および状態算出プログラム

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO1993007448A1 (en) 1991-10-04 1993-04-15 Furuno Electric Company, Limited Display apparatus
JP4321554B2 (ja) * 2006-06-23 2009-08-26 トヨタ自動車株式会社 姿勢角検出装置と姿勢角検出方法
JP2009115514A (ja) * 2007-11-02 2009-05-28 Seiko Epson Corp 測位方法、プログラム、測位回路及び電子機器
JP5614527B2 (ja) * 2010-03-05 2014-10-29 セイコーエプソン株式会社 姿勢情報算出装置、姿勢情報算出システム、姿勢情報算出方法及び姿勢情報算出プログラム
JP5419784B2 (ja) * 2010-04-06 2014-02-19 三菱電機株式会社 予測装置及び予測システム及びコンピュータプログラム及び予測方法

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS60111214U (ja) * 1983-12-29 1985-07-27 横河電機株式会社 航法装置
JPH0428636B2 (ja) 1987-07-21 1992-05-14 Kito Kk
JP2006194806A (ja) * 2005-01-17 2006-07-27 Japan Radio Co Ltd 船舶用表示装置
US20110210865A1 (en) * 2010-02-26 2011-09-01 Electronics And Telecommunications Research Institute Traffic control apparatus and method using navigation route information of vehicle for each navigational situation
JP2014145614A (ja) * 2013-01-28 2014-08-14 Furuno Electric Co Ltd 回頭角速度検出装置、移動体、回頭角速度検出方法、および、回頭角速度検出プログラム
JP2015025671A (ja) * 2013-07-24 2015-02-05 古野電気株式会社 状態算出装置、移動体、状態算出方法、および状態算出プログラム

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
See also references of EP3647817A4

Also Published As

Publication number Publication date
EP3647817A4 (en) 2021-01-27
EP3647817A1 (en) 2020-05-06
US20200200539A1 (en) 2020-06-25
US11255675B2 (en) 2022-02-22
JP6808835B2 (ja) 2021-01-06
JPWO2019003758A1 (ja) 2020-04-09
CN110832342A (zh) 2020-02-21

Similar Documents

Publication Publication Date Title
EP3388327B1 (en) Route setting method for underwater vehicle, underwater vehicle optimum control method using same, and underwater vehicle
JP2019094045A (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
US20170363749A1 (en) Attitude angle calculating device, method of calculating attitude angle, and attitude angle calculating program
JP2007276507A (ja) 移動体制御装置及び移動体制御方法
JP2012193965A (ja) 位置標定装置、位置標定装置の位置標定方法および位置標定プログラム
WO2021085274A1 (ja) 船舶の着岸支援装置
KR101763911B1 (ko) 자기장 외란이 심한 환경에서 수중체의 선수각 추정 장치 및 그 방법
JP6808835B2 (ja) 航跡予測装置、航跡予測方法、および、航跡予測プログラム
Noguchi et al. Wide area seafloor imaging by a low-cost AUV
JP2528833B2 (ja) 接岸制御装置
CN110057383B (zh) 一种auv推位导航系统杆臂误差标校方法
JP7190500B2 (ja) 航法装置、航法支援情報の生成方法、および、航法支援情報の生成プログラム
Liu et al. A correction method for DVL measurement error by pitch dynamics
JP6321914B2 (ja) 移動体情報算出装置、移動体情報取得装置、移動体、移動体情報算出方法、移動体情報取得方法、移動体情報算出プログラム、および移動体情報取得プログラム
JP2019199238A (ja) 航走制御方法および航走制御装置
KR20170033608A (ko) 실내 수조 환경에서의 선박 평면 운동 계측 시스템 및 방법
JP4417812B2 (ja) 船舶姿勢角測定装置
JP2023041501A (ja) 着岸支援装置、着岸支援方法、及び着岸支援プログラム
WO2023062782A1 (ja) 情報処理装置、制御方法、プログラム及び記憶媒体
JP7060158B2 (ja) 制御システム、制御装置、制御対象物、制御方法、及び制御プログラム
WO2023238733A1 (ja) 自律型無人潜水船
CN105283733A (zh) 用于提供方位角的设备
JP2994111B2 (ja) 潮流計

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: 18825136

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 2019526709

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: 2018825136

Country of ref document: EP

ENP Entry into the national phase

Ref document number: 2018825136

Country of ref document: EP

Effective date: 20200130