Method for calculating track deviation of steering instrument

By calculating the heading angle deviation and the turning center radius and adjusting the track in real time, the problem of calculating the ship's track deviation is solved and navigation safety is improved.

CN118938916APending Publication Date: 2024-11-12CSSC MARINE TECH CO LTD
View PDF 0 Cites 5 Cited by

Patent Information

Application Number
CN202410994245.4
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-24
Publication Date
2024-11-12

AI Technical Summary

Technical Problem

The prior art is difficult to quickly and accurately calculate the track deviation of a ship, which may cause the ship to cross the planned route and affect navigation safety.

Method used

By obtaining the latitude and longitude information of the ship's current position and planned route, calculating the heading angle deviation, judging and adjusting the track in real time, especially in the turning stage, using the turning center and radius to calculate the track deviation, ensuring that the ship sails along the predetermined route.

Benefits of technology

It realizes fast and accurate track deviation calculation and adjustment, avoids ships from deviating from planned routes and improves navigation safety.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118938916A_ABST
    Figure CN118938916A_ABST
Patent Text Reader

Abstract

The invention discloses a method for calculating track deviation of a steering instrument, which comprises the following steps of: when a ship navigates linearly, calculating a course angle theta1 of a planned route according to longitude and latitude information of a starting point and an end point of the planned route, and calculating a constant direction course angle theta1-theta according to longitude and latitude information of a current position of the ship and the longitude and latitude information of the starting point of the planned route; calculating a track deviation d according to the course angle theta 1 of the planned route and the course angle theta 1-theta of the constant direction line; when the ship turns, the course angle difference phi of the adjacent planned routes is calculated, then the coordinate of the turning circle center O point is obtained, then the distance Dso between the two points can be obtained through the coordinate of the circle center O and the actual position of the ship, then the track deviation d of the ship during turning is calculated according to the turning radius, and whether the ship deviates from the planned routes or not can be judged through the track deviation d. Therefore, the ship track is rapidly controlled, and the ship is prevented from leaving the planned route.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the technical field of ship instruments and equipment, and in particular to a method for calculating a steering instrument track deviation. Background Art

[0002] The track control system is an automatic steering system that realizes the course keeping and track tracking during the ship's navigation and controls the ship to sail along the planned route.

[0003] The ship's track deviation can be calculated quickly and accurately. Once the ship is found to be out of the deviation zone, the track control method is immediately adopted to make the ship quickly return to the planned route, greatly improving the navigation safety of the ship. Summary of the invention

[0004] In view of this, the present invention provides a method for calculating a steering instrument track deviation to solve the problems existing in the above-mentioned background technology.

[0005] A method for calculating a steering instrument track deviation specifically comprises the following steps:

[0006] S1, obtain the latitude and longitude information of the current position of the ship;

[0007] Get the latitude and longitude information of the starting point and end point on the planned route;

[0008] S2, calculating the planned route heading angle θ1 according to the latitude and longitude information of the starting point and the end point on the planned route, and calculating the rhumb line heading angle θ1-θ according to the latitude and longitude information of the current position of the ship and the latitude and longitude information of the starting point of the planned route;

[0009] S3, calculate the heading angle deviation θ according to the heading angle θ1 of the planned route and the heading angle θ1-θ of the constant line, and then calculate the track deviation d, and compare the track deviation d with the track allowable deviation value ER to determine whether the ship deviates from the track. If it deviates, adjust the track according to the deviation distance. If it does not deviate, continue to sail in a straight line according to the original planned route.

[0010] Preferably, step S4 is also included, when the ship is about to leave the current planned route and head towards the turning point to turn into the next planned route, the actual distance between the current position of the ship and the turning point is calculated in real time, when the distance is equal to the rudder turning distance, the ship is controlled to start turning immediately, and the track deviation d' of the ship is calculated in real time during the turning stage, and the track is adjusted according to the track deviation d' so that the ship sails along a turning arc with a turning center O and a turning radius R.

[0011] Preferably, the calculation process of the dynamic rudder turning distance is:

[0012] The dynamic steering point B is calculated according to the current speed of the ship;

[0013] Assuming that the ship starts to steer from point B at δ0 (right rudder) while sailing straight ahead, then due to inertia, the lag distance of the ship still moving along the original straight line at the original speed V is

[0014]

[0015] Assuming that the ship enters a normal turn immediately after passing the delay distance, ignoring the speed change during the ship's change of direction, then:

[0016] Calculate the turning radius based on the current speed V and the set turning rate r

[0017] Calculate the heading angle difference Φ between adjacent planned routes = θ2-θ1;

[0018] Calculate the theoretical turning distance between the theoretical turning point C and the planned route end point D

[0019]

[0020] According to the lag distance and theoretical starting distance Calculate the rudder turning distance

[0021]

[0022] Where T is the time constant in the Nomoto ship motion model; t1 is the rudder time from 0 to δ0. If the rudder angle is processed at a uniform rate, the time from 35° to 30° is 28s, then θ1 is the heading angle of the ship's current planned route, and θ2 is the heading angle of the next planned route.

[0023] Preferably, the specific steps of calculating the track deviation d' of the ship in real time during the turning phase are:

[0024] According to the heading angle difference between adjacent planned routes As well as the heading angle θ1 of the ship's current planned route, the angle θ3 between the vector direction from the turning center O to the waypoint D and the true north can be calculated.

[0025]

[0026] According to the heading angle difference between adjacent planned routes And the turning radius R calculates the distance D from waypoint D to the turning center O do ,

[0027]

[0028] According to the latitude and longitude information of waypoint D, the coordinates (x2, y2) in the Mercator projection coordinate system, the vector direction θ3 from the turning circle center O to waypoint D and the distance D from waypoint D to the turning circle center O are converted into do , calculate the coordinates of the center O (x0, y0),

[0029]

[0030] Use the distance D between the actual position of the ship and the center of the turning circle so Calculate the track deviation during the turning phase with the turning radius R

[0031]

[0032] Where (xs, ys) is the longitude and latitude of the current position of the ship converted into the coordinates in the Mercator projection coordinate system.

[0033] Preferably, the latitude and longitude information of the current position of the ship in step S1 is obtained through a GPS satellite navigation system or an integrated navigation system;

[0034] The latitude and longitude information of the starting point and the end point on the planned route are obtained through electronic nautical charts.

[0035] Preferably, in step S2, the calculation process of the course angle θ1 of the planned route during straight-line navigation is:

[0036] Calculate the latitude difference between the starting and ending points of the planned route The latitude elongation rates MPA, MPB and the difference in latitude elongation rates between two points DMP1;

[0037] According to the longitudes of the starting point and the end point of the planned route, calculate the longitude difference Dλ1 between the two points;

[0038] The planned route heading angle θ1 is calculated based on the latitude growth rate difference DMP1 and longitude difference Dλ1 of the planned route starting point and end point.

[0039]

[0040] Preferably, in step S2, the calculation process of the rhumb line heading angle θ1-θ is:

[0041] Calculate the latitude difference between the current position of the ship and the latitude of the starting point of the planned route. The latitude elongation MPA, MPP and the difference in latitude elongation between two points DMP2;

[0042] According to the latitude of the current position of the ship and the longitude of the starting point of the planned route, the longitude difference Dλ2 between the two points is calculated;

[0043] The heading angle θ1-θ of the rhumb line is calculated based on the latitude growth rate difference DMP2 and the longitude difference Dλ2 between the current position of the ship and the starting point of the planned route.

[0044]

[0045] Preferably, in step S3, the specific steps of calculating the track deviation d according to the planned route heading angle θ1 and the rhumb line heading angle θ1-θ are:

[0046] Calculate the angle θ based on the planned route heading angles θ1 and θ1-θ;

[0047] According to the heading angle θ1-θ of the rhumb line and the latitude difference between the current position of the ship and the starting point of the planned route Calculate the distance S between the current position of the ship and the starting point of the planned route,

[0048] According to the angle θ and the distance S between the current position of the ship and the starting point of the planned route, the track deviation d of the ship at the current position is calculated, d = S*sinθ.

[0049] Preferably, the specific steps of adjusting the track according to the track deviation in step S3 and step S4 are:

[0050] The track controller calculates the command heading according to the calculated track deviation d, and transmits the command heading to the heading controller;

[0051]

[0052] Where: e(t) is the real-time track deviation, h(t) is the real-time heading of the ship, u(t) is the output command heading, Kp is the proportional coefficient, T i —Integral time constant, T d — is the differential time constant;

[0053] The heading controller compares the actual heading collected by the compass with the received command heading, obtains a command rudder angle according to the heading control algorithm, and transmits the command rudder angle to the rudder angle controller;

[0054] The rudder angle controller compares the actual rudder angle value collected by the rudder angle feedback device with the received command rudder angle, and drives the rudder angle to rotate until the actual rudder angle of the ship is equal to the command rudder angle.

[0055] The beneficial effects of the present invention are:

[0056] The present invention calculates the track deviation according to two navigation states of the ship. When the ship is sailing in a straight line, the heading angle θ1 of the planned route is calculated according to the longitude and latitude information of the starting point and the end point of the planned route, the heading angle θ1-θ of the constant direction line is calculated according to the longitude and latitude information of the current position of the ship and the longitude and latitude information of the starting point of the planned route, and the heading angle deviation θ is calculated according to the heading angle θ1 of the planned route and the heading angle θ1-θ of the constant direction line, and then the track deviation d is obtained; when the ship turns, AD and DF are two adjacent planned routes, and the heading angle difference of the adjacent planned routes is calculated according to the longitude and latitude of points A, D and F. Then the coordinates of the turning circle center point O are obtained, and then the distance Dso between the two points can be calculated using the coordinates of the center point O and the actual position of the ship. Then the track deviation d of the ship when turning is calculated based on the turning radius. The track deviation d can be used to determine whether the ship deviates from the planned route, thereby quickly controlling the ship's track to prevent the ship from leaving the planned route. BRIEF DESCRIPTION OF THE DRAWINGS

[0057] In order to more clearly illustrate the technical solutions of the embodiments of the present invention, the drawings required for use in the embodiments will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.

[0058] Figure 1 It is a schematic diagram of track navigation control;

[0059] Figure 2 This is a schematic diagram of the calculation of track deviation when the ship is on a straight route;

[0060] Figure 3 It is a schematic diagram of the movement of the turning point for track control. DETAILED DESCRIPTION

[0061] In order to make the purpose, technical scheme and advantages of the present invention clearer, the present invention is described below by the specific embodiments shown in the accompanying drawings. However, it should be understood that these descriptions are only exemplary and are not intended to limit the scope of the present invention. In addition, in the following description, the description of well-known structures and technologies is omitted to avoid unnecessary confusion of the concept of the present invention.

[0062] The terms used in this disclosure are for the purpose of describing specific embodiments only and are not intended to limit the disclosure. The singular forms of "a", "said" and "the" used in this disclosure and the appended claims are also intended to include plural forms unless the context clearly indicates otherwise. It should also be understood that the term "and / or" used herein refers to and includes any or all possible combinations of one or more associated listed items.

[0063] In order to better understand the technical solution of the present invention, the present invention is described in detail below with reference to the accompanying drawings.

[0064] The traditional PID control algorithm is simple, robust, and flexible and is widely used in industrial process control. By adjusting the proportional coefficient Kp, integral coefficient Ki, and differential coefficient Kd, the changes in the ship's state and the changes in the environment such as wind, waves, and currents can be compensated, and the output control quantity is relatively stable with high steady-state accuracy.

[0065] PID controller is a proportional, integral, differential controller. It is a linear controller and a simple algorithm based on the "past", "present" and "future". It is the basis for complex adjustments and direct digital control by computers.

[0066] Control the deviation based on the given value r(t) and the actual output value c(t): e(t) = r(t) - c(t)

[0067] The proportion (P), integral (l) and differential (D) of the deviation are linearly combined to form the control quantity, which controls the controlled object, so it is called PID controller.

[0068] If the ship is within the deviation band, it can be considered that the actual navigation accuracy of the ship has met the requirements of the planned navigation accuracy. Once the ship is found to be out of the deviation band, the track control method of the present invention can be adopted to control the course of the ship so that the ship can quickly return to the planned route.

[0069] The present invention provides a method for calculating a steering instrument track deviation, which specifically comprises the following steps:

[0070] S1, obtain the latitude and longitude information of the current position of the ship.

[0071] Get the latitude and longitude information of the starting point and end point on the planned route.

[0072] The latitude and longitude information of the current position of the ship can be obtained through the GPS satellite navigation system or the integrated navigation system.

[0073] The latitude and longitude information of the starting point and the end point on the planned route are obtained through electronic nautical charts.

[0074] like Figure 2 As shown, Figure 2 Point A is the starting point of the planned route, point B is the end point of the planned route, point P is the current location of the ship, and the planned route is a straight line.

[0075] S2, calculate the planned route heading angle θ1 according to the latitude and longitude information of the starting point A and the end point B on the planned route, that is:

[0076] Calculate the latitude difference between the starting point A and the end point B on the planned route. The latitude elongation rates MPA, MPB and the difference in latitude elongation rates between two points DMP1;

[0077] According to the longitudes of the starting point A and the end point B on the planned route, calculate the longitude difference Dλ1 between the two points;

[0078] The heading angle θ1 of the rhumb line is calculated based on the latitude growth rate difference DMP1 and longitude difference Dλ1 between the starting point A and the end point B on the planned route.

[0079]

[0080] The heading angle θ1-θ of the constant line is calculated based on the latitude and longitude information of the current position of the ship and the latitude and longitude information of the starting point A on the planned route, that is:

[0081] According to the latitude of the ship's current position P and the latitude of the starting point A on the planned route, calculate the latitude difference between the two points The latitude elongation MPA, MPP and the difference in latitude elongation between two points DMP2;

[0082] According to the latitude of the current position P of the ship and the longitude of the starting point A on the planned route, the longitude difference Dλ2 between the two points is calculated;

[0083] The heading angle θ1-θ of the rhumb line is calculated based on the latitude growth rate difference DMP2 and the longitude difference Dλ2 between the current position P of the ship and the starting point A on the planned route.

[0084]

[0085] S3, calculate the track deviation d according to the planned route heading angle θ1 and the rhumb line heading angle θ1-θ, compare the track deviation d with the track allowable deviation value ER to determine whether the ship deviates from the track. If it deviates, adjust the track according to the deviation distance. If it does not deviate, continue to sail according to the original planned route.

[0086] Specifically, the specific steps of calculating the track deviation d according to the planned route heading angle θ1 and the rhumb line heading angle θ1-θ are:

[0087] First, the angle θ is calculated based on the planned route heading angle θ1 and the rhumb line heading angle θ1-θ;

[0088] Then, according to the heading angle θ1 of the rhumb line and the latitude difference between the current position of the ship and the starting point of the planned route, Calculate the distance S between the current position of the ship and the starting point of the planned route,

[0089] Then, according to the angle θ and the distance S between the current position of the ship and the starting point of the planned route, the track deviation d of the ship at the current position is calculated, d=S*sinθ.

[0090] The track deviation d is compared with the track allowable deviation value ER to determine whether the ship deviates from the track. If it deviates, the track controller calculates the command heading according to the calculated track deviation d and transmits the command heading to the heading controller;

[0091]

[0092] Where: e(t) is the real-time track deviation, h(t) is the real-time heading of the ship, u(t) is the output command heading, Kp is the proportional coefficient, T i —Integral time constant, T d — is the differential time constant;

[0093] The heading controller compares the actual heading collected by the compass with the command heading received, obtains a command rudder angle according to the heading control algorithm, and transmits the command rudder angle to the rudder angle controller; the rudder angle controller compares the actual rudder angle value collected by the rudder angle feedback device with the command rudder angle received, and drives the rudder angle to rotate until the actual rudder angle of the ship is equal to the command rudder angle. If there is no deviation, the heading control algorithm will continue to be used to continue straight-line navigation according to the original planned route.

[0094] The function of the above track controller is mainly to recalculate the ship's command heading according to the size of the ship's track deviation and pass it to the heading controller. The role of the heading controller is to quickly stabilize the ship's heading and achieve the purpose of eliminating the track deviation.

[0095] When a ship is sailing at high speed, due to the large inertia of the ship, if it starts turning when it reaches the next turning point, it will inevitably cause the ship to deviate from the route and increase the voyage. When the turning angle is too large, it will even affect the navigation stability of the ship. Therefore, turning point control is very important for track control.

[0096] During the turning process, due to factors such as ship speed, turning radius and turning angle, the track deviation may be greater than the preset track deviation. Therefore, the track deviation is appropriately magnified during the turning process, and then reduced to the original value when the ship smoothly enters the next track line.

[0097] Therefore, when the ship is about to leave the planned route of the current straight segment and head towards the turning point B to turn to enter the next planned route (that is, when the ship is sailing on the current straight segment track line and is about to turn to enter the next planned route), it is necessary to calculate the actual distance between the current position of the ship and the turning point in real time, and compare the actual distance between the two points with the dynamic rudder turning distance. When the actual distance between the two points is equal to the dynamic rudder turning distance, the ship is controlled to start turning immediately, and the track deviation d' of the ship is calculated in real time during the turning stage. According to the track deviation d', the track is adjusted so that the ship follows the turning arc with the turning center O and the turning radius R ( Figure 3 The arc in ) sailing.

[0098] Specifically, the calculation process of the dynamic rudder turning distance is as follows:

[0099] like Figure 3 As shown, Figure 3 The schematic diagram of the trajectory control turning point movement, in which AD and DF are two adjacent planned routes, and D is the end point of the current planned route (equivalent to Figure 2 Point A is the starting point of the current planned route, point B is the rudder point calculated at the current speed, point C is the theoretical turning point, d is the turning distance, and point E is the position of the ship on the next planned route after turning. To plan a turning arc tangent to AD and DF according to the current speed and turning rate.

[0100] First, the dynamic rudder point B is calculated according to the current speed of the ship;

[0101] Assuming that the ship starts to steer from point B to right, due to inertia, the ship initially continues to travel a distance along the original straight line at the original speed V. It is called the lag distance or the center distance.

[0102]

[0103] Assuming that the ship enters a normal turn immediately after passing the delay distance, ignoring the speed change during the ship's change of direction, then:

[0104] Calculate the turning radius based on the current speed V and the set turning rate r

[0105] Calculate the heading angle difference Φ = θ2 - θ1 between the adjacent planned routes AD and DF;

[0106] Calculate the theoretical turning distance between the theoretical turning point C and the planned route end point D

[0107]

[0108] According to the lag distance and theoretical starting distance Calculate the rudder turning distance

[0109]

[0110] In the above formula, T is the time constant in the Nomoto ship motion model; t1 is the rudder movement time from 0 to δ0. If the movement of the rudder angle is treated as a uniform rate, the time from 35° left to 30° right is 28s, then θ1 is the heading angle of the ship's current route, and θ2 is the heading angle of the next planned route.

[0111] According to the heading angle difference between adjacent planned routes As well as the heading angle θ1 of the ship's current route, the angle θ3 between the vector direction from the turning circle center O to the waypoint D and the true north can be calculated.

[0112]

[0113] According to the heading angle difference between adjacent planned routes And the turning radius R calculates the distance D from waypoint D to the turning center O do ,

[0114]

[0115] According to the latitude and longitude information of waypoint D, the coordinates (x2, y2) in the Mercator projection coordinate system, the vector direction θ3 from the turning circle center O to waypoint D and the distance D from waypoint D to the turning circle center O are converted into do , calculate the coordinates of the center O (x0, y0),

[0116]

[0117] Use the distance D between the actual position of the ship and the center of the turning circle so Calculate the track deviation during the turning phase with the turning radius R

[0118]

[0119] Where (xs, ys) is the longitude and latitude of the current position of the ship converted into the coordinates in the Mercator projection coordinate system.

[0120] When a ship is sailing on the current straight route and is about to turn to enter the next planned route, the track control algorithm continuously calculates the distance between its current position and the next turning point. Once the distance between its current position and the next turning point is equal to the rudder turning distance, the ship will equal, immediately control the ship to turn, and calculate the track deviation d' in real time during the turning process, and adjust the ship's position in real time according to the track deviation d', so that the track deviation d' gradually approaches 0, even if the ship can follow the turning arc line with the turning center O and the turning radius R during the turning stage. Sailing.

[0121] It should be clear that the described embodiments are only part of the embodiments of the present invention, rather than all the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

Claims

1. A method for calculating a steering instrument track deviation, characterized in that: The specific steps include: S1, obtain the latitude and longitude information of the current position of the ship; Get the latitude and longitude information of the starting point and end point on the planned route; S2, calculating the planned route heading angle θ1 according to the latitude and longitude information of the starting point and the end point on the planned route, and calculating the rhumb line heading angle θ1-θ according to the latitude and longitude information of the current position of the ship and the latitude and longitude information of the starting point of the planned route; S3, calculate the heading angle deviation θ according to the heading angle θ1 of the planned route and the heading angle θ1-θ of the constant line, and then calculate the track deviation d, and compare the track deviation d with the track allowable deviation value ER to determine whether the ship deviates from the track. If it deviates, adjust the track according to the deviation distance. If it does not deviate, continue to sail in a straight line according to the original planned route.

2. The method for calculating the track deviation of a steering instrument according to claim 1, characterized in that: The method further includes step S4, wherein when the ship is about to leave the current planned route and sail towards the turning point to turn to enter the next planned route, the actual distance between the current position of the ship and the turning point is calculated in real time, and when the distance is equal to the rudder turning distance, the ship is controlled to start turning immediately, and the track deviation d' of the ship is calculated in real time during the turning stage, and the track is adjusted according to the track deviation d' so that the ship sails along a turning arc with a turning center O and a turning radius R.

3. The method for calculating the track deviation of a steering instrument according to claim 2, characterized in that: The calculation process of the dynamic rudder turning distance is: The dynamic steering point B is calculated according to the current speed of the ship; Assuming that the ship starts to steer from point B at δ0 (right rudder) while sailing straight ahead, then due to inertia, the lag distance of the ship still moving along the original straight line at the original speed V is Assuming that the ship enters a normal turn immediately after passing the delay distance, ignoring the speed change during the ship's change of direction, then: Calculate the turning radius based on the current speed V and the set turning rate r Calculate the heading angle difference Φ between adjacent planned routes = θ2-θ1; Calculate the theoretical turning distance between the theoretical turning point C and the planned route end point D According to the lag distance and theoretical starting distance Calculate the rudder turning distance Where T is the time constant in the Nomoto ship motion model; t1 is the rudder time from 0 to δ0. If the rudder angle is processed at a uniform rate, the time from 35° to 30° is 28s, then θ1 is the heading angle of the ship's current planned route, and θ2 is the heading angle of the next planned route.

4. The method for calculating the track deviation of a steering instrument according to claim 3, characterized in that: The specific steps for calculating the ship's track deviation d' in real time during the turning phase are: According to the heading angle difference φ between adjacent planned routes and the heading angle θ1 of the ship's current planned route, the angle θ3 between the vector direction from the turning circle center O to the waypoint D and the true north can be calculated. The distance D from the waypoint D to the turning circle center O is calculated based on the heading angle difference φ between the adjacent planned routes and the turning radius R. do , D do =R / cos(φ / 2), According to the latitude and longitude information of waypoint D, the coordinates (x2, y2) in the Mercator projection coordinate system, the vector direction θ3 from the turning circle center O to waypoint D and the distance D from waypoint D to the turning circle center O are converted into do , calculate the coordinates of the center O (x0, y0), Use the distance D between the actual position of the ship and the center of the turning circle so Calculate the track deviation during the turning phase with the turning radius R Where (x s ,y s ) is the longitude and latitude of the current position of the ship converted into coordinates in the Mercator projection coordinate system.

5. The method for calculating the track deviation of a steering instrument according to claim 1, characterized in that: In step S1, the latitude and longitude information of the current position of the ship is obtained through the GPS satellite navigation system or the integrated navigation system; The latitude and longitude information of the starting point and the end point on the planned route are obtained through electronic nautical charts.

6. The method for calculating the track deviation of a steering instrument according to claim 1, characterized in that: In step S2, the calculation process of the course angle θ1 of the planned route during straight-line navigation is: Calculate the latitude difference between the starting and ending points of the planned route The latitude elongation rates MPA, MPB and the difference in latitude elongation rates between two points DMP1; According to the longitudes of the starting point and the end point of the planned route, calculate the longitude difference Dλ1 between the two points; The heading angle θ1 of the rhumb line is calculated based on the latitude growth rate difference DMP1 and longitude difference Dλ1 of the starting point and the end point of the planned route.

7. The method for calculating the track deviation of a steering instrument according to claim 1, characterized in that: In step S2, the calculation process of the rhumb line heading angle θ1-θ is: Calculate the latitude difference between the current position of the ship and the latitude of the starting point of the planned route. The latitude elongation MPA, MPP and the difference in latitude elongation between two points DMP2; According to the latitude of the current position of the ship and the longitude of the starting point of the planned route, the longitude difference Dλ2 between the two points is calculated; The heading angle θ1-θ of the rhumb line is calculated based on the latitude growth rate difference DMP2 and the longitude difference Dλ2 between the current position of the ship and the starting point of the planned route.

8. The method for calculating the track deviation of a steering instrument according to claim 7, characterized in that: In step S3, the specific steps of calculating the track deviation d according to the planned route heading angle p1 and the rhumb line heading angle p1-θ are: Calculate the angle θ based on the planned route heading angle θ1 and p1-θ; According to the heading angle p1-θ of the rhumb line and the latitude difference between the current position of the ship and the starting point of the planned route Calculate the distance S between the current position of the ship and the starting point of the planned route, According to the angle θ and the distance S between the current position of the ship and the starting point of the planned route, the track deviation d of the ship at the current position is calculated, d = S*sinθ.

9. The method for calculating the track deviation of a steering instrument according to claim 1, characterized in that: The specific steps of adjusting the track according to the track deviation in step S3 and step S4 are: The track controller calculates the command heading according to the calculated track deviation d, and transmits the command heading to the heading controller; Where: e(t) is the real-time track deviation, h(t) is the real-time heading of the ship, u(t) is the output command heading, Kp is the proportional coefficient, T i —Integral time constant, T d — is the differential time constant; The heading controller compares the actual heading collected by the compass with the received command heading, obtains a command rudder angle according to the heading control algorithm, and transmits the command rudder angle to the rudder angle controller; The rudder angle controller compares the actual rudder angle value collected by the rudder angle feedback device with the received command rudder angle, and drives the rudder angle to rotate until the actual rudder angle of the ship is equal to the command rudder angle.

Citation Information

Cited By

  • Airborne geophysical prospecting plane track measuring line guiding method and system

    CN119541278A

  • Large circle route guidance and control method based on Mercator chart

    CN120523196A

  • Self-adaptive course control method and system for twisted rudder

    CN120756642A

  • A twisted rudder adaptive course control method and system

    CN120756642B

  • Submarine optical cable curve burying ship position line planning method and system based on parameterization calculation

    CN121365488A