Propeller linkage control method, storage medium and device

Through the thruster linkage control method, mathematical modeling and thrust adjustment are used to solve the problem that a single thruster cannot achieve directional anchoring and translation, and improve the handling and user experience of the ship.

CN119079089AInactive Publication Date: 2024-12-06ZHUHAI ANTENG INNOVATION TECHNOLOGY CO LTD
View PDF 6 Cites 0 Cited by

Patent Information

Application Number
CN202411198553.2
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-29
Publication Date
2024-12-06
Estimated Expiration
Not applicable · inactive patent

AI Technical Summary

Technical Problem

Existing marine thrusters cannot achieve directional anchoring and translation functions, especially when the ship is large, the propulsion power of a single thruster is limited, and it is impossible to stably control the hull's direction and parallel displacement, which affects the user experience.

Method used

Through the linkage control method of multiple thrusters, the thrust adjustment amount and directional angle adjustment amount are automatically calculated according to the orientation angle and angular velocity of the hull and the thruster, combined with mathematical modeling, to realize the linkage propulsion of multiple machines, and realize the directional anchoring and translation functions.

Benefits of technology

It realizes the directional anchoring and translation functions of automatically controlling the hull, which improves the user experience, especially in terms of the stability and handling of large ships, making it convenient for fishermen and fishing enthusiasts to operate.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119079089A_ABST
    Figure CN119079089A_ABST
Patent Text Reader

Abstract

The invention relates to the technical field of ship control, and discloses a linkage control method of propellers, a storage medium and a device, and the method comprises the following steps: respectively obtaining orientation angles and angular velocities of a ship body and each propeller; acquiring longitude and latitude positions, north speed and east speed of the ship body; calculating the northward speed adjustment amount, the east speed adjustment amount and the orientation angle adjustment amount of the hull; establishing mathematical modeling of the ship body according to the ship body parameters; the expected thrust magnitude and the expected thrust direction of each propeller are calculated according to the mathematical modeling of the ship body and each adjustment amount; the orientation angle adjustment amount of each propeller is calculated; and the output power and angle of each propeller are adjusted according to the expected thrust of each propeller towards the angle adjustment amount. According to the linkage method of the propellers, the multiple propellers can be automatically controlled to achieve the functions of electronic directional anchoring or translation and the like only by setting the expected longitude and latitude speed, the north direction speed and the east direction speed of the ship body according to needs.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of ship control technology, and in particular to a thruster linkage control method, storage medium and device. Background Art

[0002] Marine propellers, also known as outboard motors or outboard motors, are widely used in the propulsion of small boats. When fishermen or fishing enthusiasts are working in the water, they need the boat to stay stably in a certain position, or move forward at a constant speed in a fixed direction, or pass multiple waypoints at one time. At present, most of the boats on the market use a single remote control to control a single propeller, and the propulsion power is limited. When the boat is large, the above functions cannot be achieved. Moreover, a single propeller can only achieve position anchoring, and the direction of the hull is determined by the water flow and wind direction. Sometimes it will sway and affect its use. At the same time, a single propeller cannot control the parallel displacement of the hull and cannot move horizontally close to the dock. For this reason, it is necessary to design a propeller linkage control method that can realize the control scheme of directional anchoring and translation functions by controlling multiple propellers on both sides of the hull to work together to improve the user experience. Summary of the invention

[0003] In order to overcome the shortcomings of the prior art, the purpose of the present invention is to provide a linkage control method for outboard motors, which can automatically calculate the thrust adjustment amount and the heading angle adjustment amount of each thruster according to the heading angle and angular velocity of the hull and each thruster combined with the mathematical modeling of the hull, and realize the functions of directional anchoring and translation by multi-machine linkage propulsion of the hull.

[0004] To solve the above problems, the technical solution adopted by the present invention is as follows: a linkage control method of a propeller, wherein a plurality of propellers are symmetrically arranged on both sides of a hull, comprising the following steps:

[0005] Obtain the orientation angle and angular velocity of the hull and each propeller respectively;

[0006] Get the longitude and latitude position, north speed and east speed of the ship;

[0007] Calculating a north speed adjustment amount, an east speed adjustment amount and a heading angle adjustment amount of the ship according to the expected longitude and latitude position, the expected north speed, the expected east speed, the expected heading angle, the heading angle of the ship, the angular velocity of the ship, the longitude and latitude position of the ship, the north speed of the ship and the east speed of the ship;

[0008] Establish mathematical modeling of the hull according to the hull parameters;

[0009] The expected thrust magnitude and expected thrust direction of each propeller are calculated based on the mathematical modeling of the hull, the north speed adjustment, the east speed adjustment and the heading angle adjustment;

[0010] Calculate the heading angle adjustment amount of each thruster according to the desired thrust direction, heading angle and angular velocity of each thruster;

[0011] The output power of each thruster is adjusted according to the desired thrust size of each thruster, and the angle of each thruster is adjusted according to the heading angle adjustment amount of each thruster.

[0012] Compared with the prior art, the beneficial effect of the present invention is that the adjustment amount of the north speed, east speed and heading angle of the ship can be automatically calculated by the current longitude and latitude of the ship, the north speed and the east speed and the expected longitude and latitude position, the north speed and the direction speed, and the adjustment amount is solved in combination with the mathematical modeling of the ship to obtain the expected thrust size and expected thrust direction of each propeller, so as to realize the linkage control of multiple stacked propellers on the ship. By reasonably setting the expected longitude and latitude, the expected north speed and the expected east speed, the ship can be automatically controlled to realize functions such as directional anchoring and translation, which is convenient to use and improves the user experience of fishermen and fishing enthusiasts.

[0013] In the above-mentioned method for controlling linkage of propellers, the step of respectively obtaining the orientation angle and angular velocity of the hull and each propeller comprises:

[0014] Obtain the magnetic declination, acceleration and deflection angle of the hull and each thruster on the x, y and z axes;

[0015] The attitude matrix of the hull and each propeller is solved according to the magnetic declination, acceleration and deflection angle of each hull and each propeller on the x, y and z axes;

[0016] The orientation angle and angular velocity of the hull and each propeller are calculated according to the attitude matrix and deflection angle of the hull and each propeller.

[0017] In the above-mentioned linkage control method of the thruster, in the step of calculating the north speed adjustment amount, the east speed adjustment amount and the heading angle adjustment amount of the hull according to the expected longitude and latitude position, the expected north speed, the expected east speed, the expected heading angle, the heading angle of the hull, the angular velocity of the hull, the longitude and latitude position of the hull, the north speed of the hull and the east speed of the hull, the calculation formulas of the north speed adjustment amount, the east speed adjustment amount and the heading angle adjustment amount are as follows:

[0018]

[0019] Among them, Λ North is the northward velocity adjustment, Λ East is the eastward speed adjustment, Λ Hdg is the amount of adjustment of the orientation angle, is the desired longitude, is the desired latitude, δ Lonis the longitude of the ship, δ Lat is the latitude of the ship, ∏ North (·) is the conversion function from longitude and latitude error to north distance error, ∏ East (·) is the conversion function from latitude and longitude error to easting distance error, is the expected northward velocity, is the expected eastward velocity, v North is the northward speed of the ship, v East is the eastward speed of the ship, is the desired orientation angle, is the heading angle of the hull, ω Hdg,boat is the angular velocity of the ship, k θ , k θ , k θ and k θ are all non-negative gain adjustment parameters.

[0020] In the above-mentioned linkage control method of the propellers, in the step of calculating the expected thrust magnitude and expected thrust direction of each propeller according to the mathematical modeling of the hull, the north speed adjustment amount, the east speed adjustment amount and the heading angle adjustment amount, the calculation formula of the expected thrust magnitude and expected thrust direction of each propeller is as follows:

[0021]

[0022] Among them, T1, T2, ..., T n is the expected thrust of each thruster, is the desired thrust direction of each thruster, Mathematical modeling of the hull M boat The optimal inverse solution under specific parameters, Λ North is the northward velocity adjustment, Λ East is the eastward speed adjustment, Λ Hdg is the amount of adjustment for the orientation angle.

[0023] In the above-mentioned method for controlling linkage of thrusters, in the step of calculating the orientation angle adjustment amount of each thruster according to the desired thrust direction, orientation angle and angular velocity of each thruster, the calculation formula of the orientation angle adjustment amount of each thruster is as follows:

[0024]

[0025] Among them, Λ n is the heading angle adjustment of the nth thruster, The desired thrust direction of the nth thruster, is the heading angle of the nth thruster, ω Hdg,n is the angular velocity of the nth thruster, k p and kd are all non-negative gain adjustment parameters.

[0026] In the above-mentioned linkage control method of the thrusters, in the step of obtaining the longitude and latitude position of the hull, the north speed and the east speed, the longitude and latitude position of the hull is the average value of the longitude and latitude obtained by the GPS positioning module arranged on the hull and the GPS positioning module arranged on each thruster.

[0027] A storage medium stores program codes, which, when called and executed by a computer, implement the above-mentioned linkage control method of the thruster.

[0028] A control device comprises: an acquisition unit for acquiring the heading angle, angular velocity, longitude and latitude position, north speed and east speed of a hull and each propeller, and acquiring the expected longitude and latitude position, expected north speed and expected east speed of the hull; an adjustment amount calculation unit for calculating the north speed adjustment amount, east speed adjustment amount and heading angle adjustment amount of the hull according to the expected longitude and latitude position, expected north speed, expected east speed, expected heading angle, the heading angle of the hull, the angular velocity of the hull, the longitude and latitude position of the hull, the north speed of the hull and the east speed of the hull; a thrust calculation unit for solving the expected thrust magnitude and expected thrust direction of each propeller according to the mathematical modeling of the hull, the north speed adjustment amount, the east speed adjustment amount and the heading angle adjustment amount, and calculating the heading angle adjustment amount of each propeller according to the expected thrust direction, heading angle and angular velocity of each propeller.

[0029] The above-mentioned control device also includes: a thrust adjustment unit, which is used to adjust the output power of each thruster according to the expected thrust size of each thruster, and adjust the angle of each thruster according to the orientation angle adjustment amount of each thruster.

[0030] A linkage control system for thrusters, comprising: the above-mentioned control device, which is arranged on the hull; a hull direction sensing unit, which is arranged on the hull, has the same direction as the hull direction and is electrically connected to the control device; a hull positioning unit, which is arranged on the hull to which it belongs and is electrically connected to the control device; a plurality of thrusters, which are symmetrically arranged in pairs on both sides of the hull; a plurality of thruster control units, which are correspondingly arranged on each of the thrusters, are electrically connected to the corresponding thrusters, and are communicatively connected to the control device; a plurality of thruster direction sensing units, which are correspondingly arranged on each of the thrusters, have the same direction as the corresponding thrusters, and are electrically connected to the corresponding thruster control units.

[0031] The present invention is further described in detail below in conjunction with the accompanying drawings and specific embodiments. BRIEF DESCRIPTION OF THE DRAWINGS

[0032] Figure 1A control flow chart of a linkage control method for a thruster according to an embodiment of the present invention;

[0033] Figure 2 The figure is a principle block diagram of a linkage control system of a thruster according to an embodiment of the present invention. DETAILED DESCRIPTION

[0034] The embodiments of the present invention are described in detail below. Figure 1 , an embodiment of the present invention provides a linkage control method for a thruster, comprising the following steps:

[0035] Obtain the orientation angle and angular velocity of the hull and each propeller respectively;

[0036] Get the longitude and latitude position, north speed and east speed of the ship;

[0037] Calculating a north speed adjustment amount, an east speed adjustment amount and a heading angle adjustment amount of the ship according to the expected longitude and latitude position, the expected north speed, the expected east speed, the expected heading angle, the heading angle of the ship, the angular velocity of the ship, the longitude and latitude position of the ship, the north speed of the ship and the east speed of the ship;

[0038] Establish mathematical modeling of the hull according to the hull parameters;

[0039] The expected thrust magnitude and expected thrust direction of each propeller are calculated based on the mathematical modeling of the hull, the north speed adjustment, the east speed adjustment and the heading angle adjustment;

[0040] Calculate the heading angle adjustment amount of each thruster according to the desired thrust direction, heading angle and angular velocity of each thruster;

[0041] The output power of each thruster is adjusted according to the desired thrust size of each thruster, and the angle of each thruster is adjusted according to the heading angle adjustment amount of each thruster.

[0042] The linkage control method of the thrusters in the embodiment of the present invention only needs to set the expected longitude and latitude position of the hull, the expected north speed and the expected direction speed as needed, and the expected thrust size and direction angle adjustment amount required by each thruster can be automatically calculated, which is convenient for controlling the hull with multiple thrusters to realize directional anchoring and translation and other functions. The control is simple and convenient, which can greatly improve the user experience of fishermen and fishing enthusiasts. If electronic directional anchoring is required, the expected longitude and latitude position is set to the position coordinates where directional anchoring is required, and the expected north speed and the expected east speed are respectively set to the opposite numbers of the north speed and east speed of the water or ocean current to offset the propulsion effect of the water and ocean current on the hull. The above method can be combined with the current direction angle and angular velocity of each thruster, as well as the mathematical modeling of the hull, to automatically calculate the expected thrust size and direction angle adjustment amount of each thruster, automatically adjust the output power and angle of each thruster, and stop the hull stably and directionally at the expected position on the water surface. The same is true for translation. The expected longitude and latitude positions of the hull are set according to the position to be moved to, and the angles between the lateral direction in which the lateral movement is required and the north and east directions are calculated based on the heading angle, angular velocity and longitude and latitude positions of the hull. The components of the expected translational speed of the hull in the north and east directions are calculated based on the angles between the lateral direction and the north and east directions, and the calculated components of the speed in the north and east directions are set as the expected north speed and expected moving speed of the hull.

[0043] It can be understood that in this embodiment, in order to ensure the accuracy of the orientation angle and angular velocity of the hull and each propeller, the attitude matrix of the hull and each propeller is solved by the magnetic declination, acceleration and deflection angle on the three axes of the hull and each propeller, and the data of the nine axes are integrated through the attitude matrix to obtain the accurate orientation angle and angular velocity of the hull and each propeller, thereby improving the stability of control. Specifically, the following steps are included:

[0044] Obtain the magnetic declination, acceleration and deflection angle of the hull and each thruster on the x, y and z axes;

[0045] The attitude matrix of the hull and each propeller is solved according to the magnetic declination, acceleration and deflection angle of each hull and each propeller on the x, y and z axes;

[0046] The orientation angle and angular velocity of the hull and each propeller are calculated according to the attitude matrix and deflection angle of the hull and each propeller.

[0047] The posture matrix is ​​a 3×3 matrix R 3×3 , its initial value can be obtained through the Euler angle (φ, θ, ψ), and its calculation formula is as follows:

[0048]

[0049] The values ​​of the Euler angles (φ, θ, ψ) can be obtained by using the geomagnetic field magnitude on the three axes and the accelerometer to obtain the initial value with deviation. The calculation formula is as follows:

[0050]

[0051] θ=sin -1 (A x ) (3)

[0052]

[0053] Among them A x , A y and A z Represents the acceleration values ​​on the three axes, M x 、M y and M z Represent the magnitude of the geomagnetic field on the three axes respectively.

[0054] The update calculation formula of the posture matrix R is as follows:

[0055]

[0056] Among them, i represents the current time, i+1 represents the next step time, and Δt is the unit step duration. is the estimated deviation of the gyroscope, vector Represents the unit direction of the Earth's gravity field, vector Represents the estimated unit direction of the Earth's magnetic field, M decl Indicates the magnetic declination of the geomagnetic field at the current longitude and latitude, k b , k a , k m and k e is a non-negative gain adjustment parameter, ω i is the angular velocity on the three axes at the current time, A i is the acceleration on the three axes at the current time, M i It is the magnitude of the geomagnetic field on the three axes at the current time.

[0057] Further, towards the angle and angular velocity ω Hdy The calculation formula is as follows:

[0058]

[0059] ω Hdg =[R 3,1 R 3,2 R 3,3 ] T ω (12)

[0060] Where R2,1 , R 1,1 , R 3,1 , R 3,2 and R 3,3 is the corresponding posture matrix R 3×3 The corresponding items in .

[0061] It can be understood that, in this embodiment, the calculation formulas for the north speed adjustment amount, the east speed adjustment amount and the heading angle adjustment amount are as follows:

[0062]

[0063] Among them, Λ North is the northward velocity adjustment, Λ East is the eastward speed adjustment, Λ Hdg is the amount of adjustment of the orientation angle, is the desired longitude, is the desired latitude, δ Lon is the longitude of the ship, δ Lat is the latitude of the ship, ∏ North (·) is the conversion function from longitude and latitude error to north distance error, ∏ East (·) is the conversion function from latitude and longitude error to easting distance error, is the expected northward velocity, is the expected eastward velocity, v North is the northward speed of the ship, v East is the eastward speed of the ship, is the desired orientation angle, is the heading angle of the hull, ω Hdg,boat is the angular velocity of the ship, k θ , k θ , k θ and k θ All are non-negative gain adjustment parameters. The adjustment of north speed and east speed is calibrated through the conversion function of longitude and latitude errors to north and east distance errors, and the gain adjustment parameters that have been adjusted after multiple tests are used to ensure the accuracy of the calculated north speed adjustment, direction speed adjustment and heading angle adjustment, and further improve the stability of control.

[0064] In this embodiment, due to the limited accuracy of GPS positioning, in order to improve the accuracy of the current longitude and latitude position of the hull, when calculating the north speed adjustment amount and the east speed adjustment amount, the average of the longitude and latitude positions of the hull and each propeller is used as the true longitude and latitude coordinates of the hull.

[0065] It is understandable that establishing a kinematic model of a mechanical structure based on mechanical structure parameters is common knowledge in the art, so the specific process of establishing a mathematical model of a hull based on hull parameters is not described in detail here. Taking the example of two propellers on the hull, the calculation formulas for the expected thrust magnitude and expected thrust direction of the two propellers are as follows:

[0066]

[0067] Among them, T1 and T2 are the expected thrusts of the left and right thrusters. and is the desired thrust direction of the two thrusters, Mathematical modeling of the hull M boat The optimal inverse solution under specific parameters includes the following steps:

[0068] First, the installation layout of the thruster is divided into four positions: left front, right front, left rear and right rear. N1, N2, N3 and N4 represent the numbers of the thrusters installed at the left front, right front, left rear and right rear positions of the hull respectively; T 1x 、T 2x 、T 3x and T 4x They represent the thrust components of the propeller in the longitudinal direction; T 1y 、T 2y 、T 3y and T 4y They represent the components of the propeller thrust generated in the lateral direction; l and w represent the length and width of the ship respectively.

[0069] According to the parameters, the kinetic model is established as follows:

[0070]

[0071] Thus, we can get T under the premise of minimum total energy change 1x 、T 2x 、T 3x 、T 4x 、T 1y 、T 2y 、T 3y and T 4y Values:

[0072]

[0073] Furthermore, the expected thrust magnitude and expected thrust direction of the thrusters at the left front, right front, left rear and right rear positions of the hull can be calculated:

[0074]

[0075] It can be understood that this embodiment involves two thrusters, namely the left front and the right front, so the expected thrust magnitude and thrust direction of the two thrusters, the left front and the right front, can be obtained by setting the installation parameters as follows:

[0076] N1=1, N2=1, N3=0, N4=0 (23)

[0077] The expected thrust magnitudes T1 and T2 of the two thrusters can be directly sent to the thrust control units of the corresponding thrusters, and the corresponding thrust control units adjust the output power of the motors according to the expected thrust magnitudes. The expected thrust direction also needs to be combined with the current heading angles and angular velocities of the two thrusters to calculate the heading angle adjustment of each thruster, and the calculation formula is as follows:

[0078]

[0079] Among them, Λ1 and Λ2 are the heading angle adjustment of the two thrusters, φ1 and are the desired thrust directions of the two thrusters, and are the orientation angles of the two thrusters, ω Hdg,1 and ω Hdg,2 are the angular velocities of the two thrusters, k p and k d are all non-negative gain adjustment parameters.

[0080] The storage medium of the embodiment of the present invention stores a program code, and when the program code is called and executed by a computer, the linkage control method of the above-mentioned propeller is realized. The control device of the embodiment of the present invention includes the above-mentioned storage medium and a computer, or includes an acquisition unit, an adjustment amount calculation unit and a thrust calculation unit. The acquisition unit is used to obtain the orientation angle, angular velocity, longitude and latitude position, north speed and east speed of the hull and each propeller from the hull direction sensing unit, the propeller direction sensing unit, the hull positioning unit and the propeller positioning unit, and obtain the expected longitude and latitude position, expected north speed and expected east speed of the hull. The adjustment amount calculation unit is used to calculate the north speed adjustment amount, east speed adjustment amount and orientation angle adjustment amount of the hull according to the expected longitude and latitude position, expected north speed, expected east speed, expected orientation angle, the orientation angle of the hull, the angular velocity of the hull, the longitude and latitude position of the hull, the north speed of the hull and the east speed of the hull. The thrust calculation unit is used to solve the expected thrust size and expected thrust direction of each propeller according to the mathematical modeling of the hull, the north speed adjustment, the east speed adjustment and the heading angle adjustment, and calculate the heading angle adjustment of each propeller according to the expected thrust direction, heading angle and angular velocity of each propeller. It can be understood that the adjustment of the propeller can be directly calculated by the control device to calculate the power and deflection angle that need to be adjusted, or the control device can send the expected thrust size and expected reasoning direction to the control unit of the propeller, and the control unit of the propeller calculates the specific motor output power and motor deflection angle. If calculated by the control device, the control device also includes a thrust adjustment unit, which is used to adjust the output power of each propeller according to the expected thrust size of each propeller, and adjust the angle of each propeller according to the heading angle adjustment of each propeller.

[0081] Reference Figure 2 The linkage control system of the propeller of the embodiment of the present invention comprises the above-mentioned control device, a hull direction sensing unit, a hull positioning unit, a plurality of propellers, a plurality of propeller control units and a plurality of propeller direction sensing units. The hull direction sensing unit and the hull positioning unit are both electrically connected to the control device, and the detection positive direction of the hull direction sensing unit is consistent with the positive direction of the hull. A plurality of propellers are symmetrically arranged on both sides of the hull in pairs, and a plurality of propeller control units are electrically connected to the corresponding propellers and are connected to the control device by wired or wireless communication. The propeller direction sensing unit is arranged on the corresponding propeller, and the detection positive direction is consistent with the propulsion direction of the corresponding propeller, and is electrically connected to the corresponding propeller control unit. In the present embodiment, a propeller positioning unit is also arranged on each propeller, which is electrically connected to the corresponding propeller control unit to obtain the longitude and latitude positions of each propeller. In the present embodiment, the propellers are arranged on both sides of the bow of the hull, and the specific positions of the propellers can be set according to actual needs.

[0082] It should be noted that in the description of the present invention, if there are any orientation descriptions, such as up, down, front, back, left, right, etc., the orientations or positional relationships indicated are all based on the orientations or positional relationships shown in the drawings. They are only for the convenience of describing the present invention and simplifying the description, and do not indicate or imply that the device or element referred to must have a specific orientation, be constructed or operated in a specific orientation, and cannot be understood as a limitation on the present invention.

[0083] In the description of the present invention, "several" means one or more, "more" means two or more, "greater than", "less than", "exceed" etc. are understood to exclude the number itself, and "above", "below", "within" etc. are understood to include the number itself. If there is a description of "first" or "second", it is only used to distinguish the technical features, and cannot be understood as indicating or implying relative importance or implicitly indicating the number of the indicated technical features or implicitly indicating the order of the indicated technical features.

[0084] In the description of the present invention, unless otherwise clearly defined, terms such as setting, installing, connecting, etc. should be understood in a broad sense, and technicians in the relevant technical field can reasonably determine the specific meanings of the above terms in the present invention based on the specific content of the technical solution.

[0085] The above-mentioned embodiments are only preferred embodiments of the present invention and cannot be used to limit the scope of protection of the present invention. Any non-substantial changes and substitutions made by technicians in this field on the basis of the present invention shall fall within the scope of protection required by the present invention.

Claims

1. A linkage control method for thrusters, wherein a plurality of thrusters are symmetrically arranged on both sides of a ship, characterized in that: The steps include: Obtain the orientation angle and angular velocity of the hull and each propeller respectively; Get the longitude and latitude position, north speed and east speed of the ship; Calculating a north speed adjustment amount, an east speed adjustment amount and a heading angle adjustment amount of the ship according to the expected longitude and latitude position, the expected north speed, the expected east speed, the expected heading angle, the heading angle of the ship, the angular velocity of the ship, the longitude and latitude position of the ship, the north speed of the ship and the east speed of the ship; Establish mathematical modeling of the hull according to the hull parameters; The expected thrust magnitude and expected thrust direction of each propeller are calculated based on the mathematical modeling of the hull, the north speed adjustment, the east speed adjustment and the heading angle adjustment; Calculate the heading angle adjustment amount of each thruster according to the desired thrust direction, heading angle and angular velocity of each thruster; The output power of each thruster is adjusted according to the desired thrust size of each thruster, and the angle of each thruster is adjusted according to the heading angle adjustment amount of each thruster.

2. The linkage control method of the thruster according to claim 1, characterized in that: The steps of respectively obtaining the orientation angle and angular velocity of the hull and each propeller include: Obtain the magnetic declination, acceleration and deflection angle of the hull and each thruster on the x, y and z axes; The attitude matrix of the hull and each propeller is solved according to the magnetic declination, acceleration and deflection angle of each hull and each propeller on the x, y and z axes; The orientation angle and angular velocity of the hull and each propeller are calculated according to the attitude matrix and deflection angle of the hull and each propeller.

3. The linkage control method of the thruster according to claim 1, characterized in that: In the step of calculating the north speed adjustment amount, the east speed adjustment amount and the heading angle adjustment amount of the hull according to the expected longitude and latitude position, the expected north speed, the expected east speed, the expected heading angle, the heading angle of the hull, the angular velocity of the hull, the longitude and latitude position of the hull, the north speed of the hull and the east speed of the hull, the calculation formulas of the north speed adjustment amount, the east speed adjustment amount and the heading angle adjustment amount are as follows: Among them, Λ North is the northward velocity adjustment, Λ East is the eastward speed adjustment, Λ Hdg is the amount of adjustment of the orientation angle, is the desired longitude, is the desired latitude, δ Lon is the longitude of the ship, δ Lat is the latitude of the ship, ∏ North (·) is the conversion function from longitude and latitude error to north distance error, ∏ East (·) is the conversion function from latitude and longitude error to easting distance error, is the expected northward velocity, is the expected eastward velocity, v North is the northward speed of the ship, v East is the eastward speed of the ship, is the desired orientation angle, is the heading angle of the hull, ω Hdg,boat is the angular velocity of the ship, k θ , k θ , k θ and k θ are all non-negative gain adjustment parameters.

4. The linkage control method of the thruster according to claim 1, characterized in that: In the step of calculating the expected thrust magnitude and expected thrust direction of each propeller according to the mathematical modeling of the hull, the north speed adjustment, the east speed adjustment and the heading angle adjustment, the calculation formula of the expected thrust magnitude and expected thrust direction of each propeller is as follows: Among them, T1, T2, ..., T n is the expected thrust of each thruster, is the desired thrust direction of each thruster, Mathematical modeling of the hull M boat The optimal inverse solution under specific parameters, Λ North is the northward velocity adjustment, Λ East is the eastward speed adjustment, Λ Hdg is the amount of adjustment for the orientation angle.

5. The linkage control method of the thruster according to claim 1, characterized in that: In the step of calculating the orientation angle adjustment amount of each propeller according to the expected thrust direction, orientation angle and angular velocity of each propeller, the calculation formula of the orientation angle adjustment amount of each propeller is as follows: Among them, Λ n is the heading angle adjustment of the nth thruster, The desired thrust direction of the nth thruster, is the heading angle of the nth thruster, ω Hdg,n is the angular velocity of the nth thruster, k p and k d are all non-negative gain adjustment parameters.

6. The linkage control method of the thruster according to claim 1, characterized in that: In the step of obtaining the longitude and latitude position, north speed and east speed of the ship, the longitude and latitude position of the ship is the average of the longitude and latitude obtained by the GPS positioning module arranged on the ship and the GPS positioning modules arranged on each propeller.

7. A storage medium storing program code, characterized in that: When the program code is called and executed by a computer, the linkage control method of the thruster according to any one of claims 1 to 6 is implemented.

8. A control device, characterized in that: include: An acquisition unit, used to acquire the orientation angle, angular velocity, longitude and latitude position, north speed and east speed of the ship and each propeller, and to acquire the expected longitude and latitude position, expected north speed and expected east speed of the ship; an adjustment amount calculation unit, for calculating a north speed adjustment amount, an east speed adjustment amount and a heading angle adjustment amount of the ship according to an expected longitude and latitude position, an expected north speed, an expected east speed, an expected heading angle, a heading angle of the ship, an angular velocity of the ship, a longitude and latitude position of the ship, a north speed of the ship and an east speed of the ship; The thrust calculation unit is used to solve the expected thrust size and expected thrust direction of each propeller according to the mathematical modeling of the hull, the north speed adjustment, the east speed adjustment and the heading angle adjustment, and calculate the heading angle adjustment of each propeller according to the expected thrust direction, heading angle and angular velocity of each propeller.

9. The control device according to claim 8, characterized in that: Also includes: The thrust adjustment unit is used to adjust the output power of each thruster according to the expected thrust size of each thruster, and adjust the angle of each thruster according to the heading angle adjustment amount of each thruster.

10. A linkage control system for a thruster, characterized in that: include: The control device according to claim 8, arranged on the hull; A hull direction sensing unit, which is arranged on the hull, has the same direction as the hull, and is electrically connected to the control device; A hull positioning unit, disposed on the hull and electrically connected to the control device; Multiple thrusters are symmetrically arranged in pairs on both sides of the hull; A plurality of thruster control units, which are correspondingly arranged on each of the thrusters, are electrically connected to the corresponding thrusters, and are communicatively connected to the control device; A plurality of propeller direction sensing units are correspondingly arranged on each of the propellers, have the same direction as the corresponding propeller, and are electrically connected to the corresponding propeller control unit.

Citation Information

Patent Citations

  • Marine Propulsion Control System and Method

    CN113371168A

  • Propeller, water area movable equipment, stabilization control method of water area movable equipment and storage medium

    CN117015500A

  • Motion control system and controller for a ship

    CN117331329A

  • Propeller, control method and device thereof, readable storage medium and ship

    CN118254947A

  • Full-degree-of-freedom marine propulsion system and control method

    CN118270213A