CN111026144A - Air cushion landing boat control method based on stability augmentation controller - Google Patents

Air cushion landing boat control method based on stability augmentation controller Download PDF

Info

Publication number
CN111026144A
CN111026144A CN201911337575.1A CN201911337575A CN111026144A CN 111026144 A CN111026144 A CN 111026144A CN 201911337575 A CN201911337575 A CN 201911337575A CN 111026144 A CN111026144 A CN 111026144A
Authority
CN
China
Prior art keywords
rudder angle
delta
heading
stability
rudder
Prior art date
Legal status (The legal status 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 status listed.)
Granted
Application number
CN201911337575.1A
Other languages
Chinese (zh)
Other versions
CN111026144B (en
Inventor
徐玉杰
付明玉
王成龙
孙硕
吴松
董李静
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Harbin Engineering University
Original Assignee
Harbin Engineering University
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 Harbin Engineering University filed Critical Harbin Engineering University
Priority to CN201911337575.1A priority Critical patent/CN111026144B/en
Publication of CN111026144A publication Critical patent/CN111026144A/en
Application granted granted Critical
Publication of CN111026144B publication Critical patent/CN111026144B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0875Control of attitude, i.e. control of roll, pitch, or yaw specially adapted to water vehicles

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

The invention belongs to the technical field of follow-up stability augmentation control of an air cushion landing boat, and particularly relates to an air cushion landing boat control method based on a stability augmentation controller. The invention aims to improve the maneuvering control stability of the air cushion landing boat during navigation. Under the follow-up mode, the stability augmentation controller achieves the purpose of improving the operation stability and the safety by increasing the course motion damping. In the design process, the operation intention of a driver needs to be judged, and the navigation rapidity and maneuverability need to be considered. The follow-up stability augmentation design is realized based on a digital signal processing technology and a heading/slew rate control idea. Aiming at a rudder angle instruction input by an operator in a follow-up mode, the invention utilizes the heading and slew rate stability augmentation control idea under automatic driving control to correct to obtain an expected rudder angle, thereby improving the stability of maneuvering control of the hovercraft during navigation.

Description

Air cushion landing boat control method based on stability augmentation controller
Technical Field
The invention belongs to the technical field of follow-up stability augmentation control of an air cushion landing boat, and particularly relates to an air cushion landing boat control method based on a stability augmentation controller.
Background
Due to the complexity and the changeability of the marine environment and the poor course stability of the air cushion landing boat, the air cushion landing boat is easy to have a yaw phenomenon under the action of external interference, so that the yaw phenomenon is accompanied with the heading phenomenon in the straight sailing process. In order to reduce the influence of this phenomenon on the hovercraft, frequent steering correction by the driver is required, and the operation intensity of the driver is increased, so that the driver is likely to be fatigued even when the hovercraft is sailed for a long time. In the process of operating and turning by a driver, a larger turning angle rate is generated sometimes, so that the camber and the sideslip of the hovercraft are caused, the operating safety is influenced, the driver is easy to judge by mistake, and the risk of misoperation is increased. Therefore, to reduce the frequency of driver maneuvers and the likelihood of false positives, the smoothness of the course-changing maneuver should be improved to improve the safety of the maneuver.
At present, most of the research on stability augmentation control methods at home and abroad is applied to the aspect of aviation movement, such as the control of the transverse and lateral movement and attitude of an unmanned aerial vehicle, the control of the longitudinal and transverse movement of an airplane and the like. However, the stability augmentation control technology of the air cushion boat is not researched systematically. But the air cushion boat plays an immeasurable role in the aspect of land and sea battles in China. Considering that the airplane and the air cushion landing boat have the characteristics of high speed and low damping when navigating, the main body can strongly swing due to small environmental interference force, and the improvement is difficult only by operation. Therefore, it is necessary to design a stability augmentation control technology to improve maneuvering stability of the air cushion landing boat during course keeping and course changing rotation.
Disclosure of Invention
The invention aims to provide an air cushion landing boat control method based on a stability augmentation controller, which improves the maneuvering stability of an air cushion landing boat during navigation, corrects a rudder angle instruction input by an operator in a follow-up mode by utilizing the heading and turning rate stability augmentation control idea under automatic driving control to obtain an expected rudder angle, and further improves the maneuvering stability of the air cushion landing boat during navigation.
The purpose of the invention is realized by the following technical scheme: the method comprises the following steps:
step 1: denoising the rudder angle signal;
filtering m rudder angle signals before the sampling time by adopting a sliding weighted average algorithm, wherein the filtered rudder angle signals are as follows:
Figure BDA0002331369610000011
wherein, deltam-iFor the current sampling of the rudder angle signal deltamThe previous i-th rudder angle signal; lambda [ alpha ]m-iFor the weighting coefficient, the calculation method is as follows:
Figure BDA0002331369610000012
step 2: the rudder angle instruction is restricted;
in order to prevent the drift phenomenon of the air cushion landing boat in the sailing process, the rudder angle instruction is restrained by combining the current sailing speed and the current turning rate, and the specific restraint is as follows:
when delta is larger than or equal to deltamaxWhen (v, γ), δ is taken to be δmax(v,γ);
When delta<δmax(v, γ), δ is δ;
wherein, deltamax(v, γ) are maximum rudder angle safety limits on velocity v and heading angle γ;
and step 3: mean rudder angle command value after calculation restraint
Figure BDA0002331369610000021
Figure BDA0002331369610000022
Wherein N is a rudder angle time sequence; the smaller the N value is, the worse the stability increasing effect is; the larger the value of N, the larger the hysteresis; deltaiA rudder angle value corresponding to each time sequence;
and 4, step 4: mean value of rudder angle instruction
Figure BDA0002331369610000023
With a set rudder angle mean value thresholdδconst1Comparing; if it is
Figure BDA0002331369610000024
Entering a heading keeping mode and adopting a PID control law
Figure BDA0002331369610000025
The resultant moment M required to be generated is obtained, and the expected rudder angle delta is obtained through inverse solution of a rudder modelc(ii) a Wherein Kp、KdAnd KIAre all PID parameters; psie=ψ-ψd,ψd=ψ1,ψ1For averaging rudder angle commands for the first time
Figure BDA0002331369610000026
With a set rudder angle mean threshold value deltaconst1Heading when comparing; if it is
Figure BDA0002331369610000027
The rudder angle command variance δ after the restraint is calculated2The variance delta of the rudder angle command2With a set rudder angle variance threshold deltaconst2Comparing; rudder angle command variance delta2The calculation method comprises the following steps:
Figure BDA0002331369610000028
the variance delta of the rudder angle instruction2With a set rudder angle variance threshold deltaconst2Comparing; if delta2const2Taking the mean value of rudder angle in a smoothing way
Figure BDA0002331369610000029
If delta2const2Then adopting a slew rate maintaining mode and adopting a PID control law
Figure BDA00023313696100000210
The resultant moment M required to be generated is obtained, and the expected rudder angle delta is obtained through inverse solution of a rudder modelc(ii) a Wherein r iseIn order to obtain the deviation of the revolution rate,re=r-rd,rdaccording to
Figure BDA00023313696100000211
Obtaining;
and 5: combining safety limit constraint, adopting heading and slew rate stability augmentation control under automatic driving control, and further obtaining the expected rudder angle deltacAnd the tail flicking rudder angle is restrained, and the heading or the turning rate is automatically controlled.
The invention has the beneficial effects that:
the invention provides an air cushion landing boat control method based on a stability augmentation controller, and aims to improve maneuvering control stability of an air cushion landing boat during navigation. Under the follow-up mode, the stability augmentation controller achieves the purpose of improving the operation stability and the safety by increasing the course motion damping. In the design process, the operation intention of a driver needs to be judged, and the navigation rapidity and maneuverability need to be considered. The follow-up stability augmentation design is realized based on a digital signal processing technology and a heading/slew rate control idea. Aiming at a rudder angle instruction input by an operator in a follow-up mode, the invention utilizes the heading and slew rate stability augmentation control idea under automatic driving control to correct to obtain an expected rudder angle, thereby improving the stability of maneuvering control of the hovercraft during navigation.
Drawings
FIG. 1 is a block diagram of a follow-up stability augmentation control of the present invention.
Fig. 2 is a graph of a rudder angle instruction without stability augmentation of a simulation result.
FIG. 3 is a graph of the slew rate without stability augmentation of simulation results.
FIG. 4 is a graph of the unstabilized heading angle of the simulation results.
FIG. 5 is a comparison diagram of rudder angles before and after stability augmentation of simulation results.
FIG. 6 is a graph of slew rate after stability augmentation of simulation results.
FIG. 7 is a diagram of a post-stabilization heading angle curve of a simulation result.
Detailed Description
The invention is further described below with reference to the accompanying drawings.
The invention designs a control method of an air cushion landing boat, in particular to a control method of an air cushion landing boat based on a stability augmentation controller. Firstly, filtering a rudder angle signal input by a hand wheel by using a sliding weighted average algorithm and restraining the signal in a safe range, thereby ensuring the smoothness of the rudder angle signal input by the hand wheel and avoiding the tail flicking phenomenon of the air cushion landing boat in the process of sailing. And then, carrying out mean value calculation on the denoised and restrained rudder angle instruction, and judging heading maintenance according to the size of the mean value. If the mean value change is small, entering a heading keeping mode; and if the mean value is large, entering variance judgment. The variance calculation is performed on the steering angle command after the restriction, and the rotation mode is determined according to the magnitude of the variance. If the variance is large, entering a rotation rate maintaining mode; if the variance is small, the mean value of the steering angle is smoothed. Finally, combining safety limit constraint, adopting heading and turning rate stability augmentation control under automatic driving control, and further obtaining an expected rudder angle deltacAnd the drift rudder angle is restrained, the heading or the revolution rate is automatically controlled, and the maneuvering control stability of the air cushion landing boat during the heading keeping and the heading changing revolution is improved.
An air cushion landing boat control method based on a stability augmentation controller comprises the following steps:
step 1: denoising the rudder angle signal;
filtering m rudder angle signals before the sampling time by adopting a sliding weighted average algorithm, wherein the filtered rudder angle signals are as follows:
Figure BDA0002331369610000031
wherein, deltam-iFor the current sampling of the rudder angle signal deltamThe previous i-th rudder angle signal; lambda [ alpha ]m-iFor the weighting coefficient, the calculation method is as follows:
Figure BDA0002331369610000032
step 2: the rudder angle instruction is restricted;
in order to prevent the drift phenomenon of the air cushion landing boat in the sailing process, the rudder angle instruction is restrained by combining the current sailing speed and the current turning rate, and the specific restraint is as follows:
when delta is larger than or equal to deltamax(v, γ) when δ is δmax(v,γ);
When delta<δmax(v, γ), δ is δ;
wherein, deltamax(v, γ) are maximum rudder angle safety limits on velocity v and heading angle γ;
and step 3: mean rudder angle command value after calculation restraint
Figure BDA0002331369610000041
Figure BDA0002331369610000042
Wherein N is a rudder angle time sequence; the smaller the N value is, the worse the stability increasing effect is; the larger the value of N, the larger the hysteresis; deltaiA rudder angle value corresponding to each time sequence;
and 4, step 4: mean value of rudder angle instruction
Figure BDA0002331369610000043
With a set rudder angle mean threshold value deltaconst1Comparing; if it is
Figure BDA0002331369610000044
Entering a heading keeping mode and adopting a PID control law
Figure BDA0002331369610000045
The resultant moment M required to be generated is obtained, and the expected rudder angle delta is obtained through inverse solution of a rudder modelc(ii) a Wherein Kp、KdAnd KIAre all PID parameters;
Figure BDA0002331369610000046
for averaging rudder angle commands for the first time
Figure BDA0002331369610000047
With a set rudder angle mean threshold value deltaconst1Heading when comparing; if it is
Figure BDA0002331369610000048
The rudder angle command variance δ after the restraint is calculated2The variance delta of the rudder angle command2With a set rudder angle variance threshold deltaconst2Comparing; rudder angle command variance delta2The calculation method comprises the following steps:
Figure BDA0002331369610000049
the variance delta of the rudder angle instruction2With a set rudder angle variance threshold deltaconst2Comparing; if delta2const2Taking the mean value of rudder angle in a smoothing way
Figure BDA00023313696100000410
If delta2const2Then adopting a slew rate maintaining mode and adopting a PID control law
Figure BDA00023313696100000411
The resultant moment M required to be generated is obtained, and the expected rudder angle delta is obtained through inverse solution of a rudder modelc(ii) a Wherein r iseIs the deviation of the slew rate, re=r-rd,rdAccording to
Figure BDA00023313696100000412
Obtaining;
and 5: combining safety limit constraint, adopting heading and slew rate stability augmentation control under automatic driving control, and further obtaining the expected rudder angle deltacAnd the tail flicking rudder angle is restrained, and the heading or the turning rate is automatically controlled.
The method mainly comprises rudder angle signal smoothing processing based on a safety limit, course/rotation mode judgment based on the change trend of the rudder angle signal and expected rudder angle inverse solution based on course/rotation PID control. Aiming at a rudder angle instruction input by an operator in a follow-up mode, the invention utilizes the heading and slew rate stability augmentation control idea under automatic driving control to correct to obtain an expected rudder angle, thereby improving the stability of maneuvering control of the hovercraft during navigation.
First, the rudder angle signal smoothing process based on the safety limit is utilized. And filtering the hand wheel input rudder angle signals m before the sampling moment by adopting a sliding weighted average algorithm. The filtered rudder angle signal is:
Figure BDA00023313696100000413
wherein, deltamFor the current sampling of the rudder angle signal, deltam-iFor the previous i-th rudder angle signal, λm-iFor the weighting coefficients, the following are calculated
Figure BDA0002331369610000051
And then, in order to prevent the drift phenomenon of the air cushion landing boat in the sailing process, the rudder angle instruction is restrained by combining the current sailing speed and the current turning rate:
when delta is larger than or equal to deltamax(v, γ) when δ is δmax(v,γ);
When delta<δmax(v, γ), δ is δ;
wherein, deltamax(v, γ) is the maximum rudder angle safety limit for v and γ.
And judging the course/rotation mode based on the change trend of the rudder angle signal. And carrying out mean value operation on the restrained rudder angle instruction, and judging heading direction keeping/variance according to the size of the mean value.
The mean rudder angle expression is as follows:
Figure BDA0002331369610000052
wherein, N is the ordinal number of the rudder angle, N should choose the appropriate value, N value is smaller and the stability-increasing effect is worse; the larger the value of N, the larger the hysteresis. DeltaiAnd the rudder angle value corresponding to each time sequence.
When in use
Figure BDA0002331369610000053
And then, entering a heading keeping mode.
When in use
Figure BDA0002331369610000054
And if so, entering variance judgment.
Wherein, deltaconst1Is a set rudder angle mean value threshold value.
The variance calculation is performed on the steering angle command after the restriction, and the rotation mode is determined according to the magnitude of the variance.
The rudder angle variance expression is as follows:
Figure BDA0002331369610000055
when delta2const2And entering a rudder angle mean value smoothing mode. Get
Figure BDA0002331369610000056
When delta2const2In this case, the slew rate maintaining mode is entered.
Wherein, deltaconst2Is a set rudder angle variance threshold value.
Desired rudder angle inverse solution based on heading/slewing PID control.
The bow direction keeping mode is as follows: taking psid=ψ1Then deviation psie=ψ-ψdBy using PID control law
Figure BDA0002331369610000057
Figure BDA0002331369610000058
The resultant moment M required to be generated is obtained, and then the expected rudder angle delta is obtained through inverse solution of a rudder modelc. Wherein psi1The current heading when the condition judgment is performed for the first time.
Slew rate retention mode: according to
Figure BDA0002331369610000059
Find its corresponding gammadThen deviation gammae=γ-γdBy using PID control law
Figure BDA0002331369610000061
The resultant moment M required to be generated is obtained, and delta is obtainedc
The invention provides an air cushion landing boat control method based on a stability augmentation controller, and aims to improve maneuvering control stability of an air cushion landing boat during navigation. Under the follow-up mode, the stability augmentation controller achieves the purpose of improving the operation stability and the safety by increasing the course motion damping. In the design process, the operation intention of a driver needs to be judged, and the navigation rapidity and maneuverability need to be considered.
The follow-up stability augmentation design is realized based on a digital signal processing technology and a heading/slew rate control idea. The method for controlling the stability increase of the heading/turning rate of a certain type of air cushion landing boat comprises the following specific steps:
in order to ensure the smoothness of a rudder angle signal input by a hand wheel and also consider the real-time property, a sliding weighted average algorithm is adopted to filter the rudder angle signal. The principle of the method is that after N continuous hand wheel signal sampling values are multiplied by different weighting coefficients respectively, the sampling values are accumulated, and the weighting coefficients are generally small and large first so as to highlight the effect of a plurality of subsequent sampling and enhance the knowledge of the system on the parameter change trend. The respective weighting coefficients are greater than 0, less than 1, and the sum is equal to 1. The sum after such weighting operation is used as the rudder angle signal value output from the hand wheel.
In order to prevent the drift phenomenon of the air cushion landing boat in the sailing process, the rudder angle instruction is restrained by combining the current sailing speed and the current rotation rate.
And carrying out mean value operation on the restrained rudder angle instruction, and judging heading direction keeping/variance according to the size of the mean value. If the mean value change is small, entering a heading keeping mode; and if the mean value is large, entering variance judgment.
The variance calculation is performed on the steering angle command after the restriction, and the rotation mode is determined according to the magnitude of the variance. If the variance is large, entering a rotation rate maintaining mode; if the variance is small, the mean value of the steering angle is smoothed.
And combining safety limit constraint, adopting heading and turning rate stability-increasing control under automatic driving control to further obtain an expected rudder angle, carrying out tail-flick rudder angle constraint, and carrying out heading or turning rate automatic control on the heading/turning rate.
The following stability augmentation control block diagram of the air cushion landing boat is shown in figure 1. An air cushion landing boat control method based on a stability augmentation controller comprises the following specific steps:
step one, denoising processing of rudder angle signals
And (3) filtering m rudder angle signals before the sampling moment by adopting a sliding weighted average algorithm. The filtered rudder angle signal is:
Figure BDA0002331369610000062
wherein, deltamFor the current sampling of the rudder angle signal, deltam-iFor the previous i-th rudder angle signal, λm-iFor the weighting coefficients, the following are calculated
Figure BDA0002331369610000063
Step two, rudder angle instruction constraint
In order to prevent the drift phenomenon of the air cushion landing boat in the sailing process, the rudder angle instruction is restrained by combining the current sailing speed and the current rotation rate.
When delta is larger than or equal to deltamax(v, γ) when δ is δmax(v,γ)
When delta<δmax(v, γ) when δ is δ
Wherein, deltamax(v, γ) is the maximum rudder angle safety limit for v and γ.
Thirdly, judging heading maintenance/variance;
and carrying out mean value operation on the restrained rudder angle instruction, and judging heading direction keeping/variance according to the size of the mean value.
The mean rudder angle expression is as follows:
Figure BDA0002331369610000071
wherein, N is the ordinal number of the rudder angle, N should choose the appropriate value, N value is smaller and the stability-increasing effect is worse; the larger the value of N, the larger the hysteresis. DeltaiAnd the rudder angle value corresponding to each time sequence.
When in use
Figure BDA0002331369610000072
And then, entering a heading keeping mode. Taking psid=ψ1Then deviation psie=ψ-ψdBy using PID control law
Figure BDA0002331369610000073
The resultant moment M required to be generated is obtained, and then the expected rudder angle delta is obtained through inverse solution of a rudder modelc. Wherein psi1The current heading when the condition judgment is performed for the first time.
When in use
Figure BDA0002331369610000074
And if so, entering variance judgment.
Wherein, deltaconst1Is a set rudder angle mean value threshold value.
Step four, judging the rotation mode
The variance calculation is performed on the steering angle command after the restriction, and the rotation mode is determined according to the magnitude of the variance.
The rudder angle variance expression is as follows:
Figure BDA0002331369610000075
wherein,
Figure BDA0002331369610000076
and N is the same as the third step.
When delta2const2At the moment, enterAnd (4) a rudder angle mean value smoothing mode. Get
Figure BDA0002331369610000077
When delta2const2In this case, the slew rate maintaining mode is entered. According to
Figure BDA0002331369610000078
Find its corresponding gammadThen deviation gammae=γ-γdBy using PID control law
Figure BDA0002331369610000079
The resultant moment M required to be generated is obtained, and then the expected rudder angle delta is obtained through inverse solution of a rudder modelc. Wherein, deltaconst2Is a set rudder angle variance threshold value.
Step five, obtaining the expected rudder angle deltac
Combining safety limit constraint, adopting heading and slew rate stability augmentation control under automatic driving control, and further obtaining expected rudder angle deltacAnd carrying out drift rudder angle constraint and carrying out heading or turning rate automatic control on the heading/turning rate.
Under the manual operation mode of 35-section navigational speed, a rudder angle instruction with noise is input, the follow-up stability augmentation function is verified, and in simulation results, a rudder angle instruction before and after stability augmentation, a turning rate and a heading angle contrast diagram are respectively shown in a figure 2, a figure 3, a figure 4, a figure 5, a figure 6 and a figure 7. The rudder angle instruction jitter after stability augmentation is obviously smaller than that before stability augmentation; under the small-mean rudder angle input interference, the course keeps stable; under the large-mean small-variance rudder angle instruction, the slew rate is kept stable, and large jitter cannot occur. The following stability augmentation technology based on the air cushion landing boat designed by the invention not only reduces the bow rolling phenomenon caused by the interference of the external environment when the boat body is in straight navigation, thereby reducing the operation intensity of a driver, but also improving the operation safety of the boat body in the rotation process.
The above description is only a preferred embodiment of the present invention and is not intended to limit the present invention, and various modifications and changes may be made by those skilled in the art. Any modification, equivalent replacement, or improvement made within the spirit and principle of the present invention should be included in the protection scope of the present invention.

Claims (1)

1. An air cushion landing boat control method based on a stability augmentation controller is characterized by comprising the following steps:
step 1: denoising the rudder angle signal;
filtering m rudder angle signals before the sampling time by adopting a sliding weighted average algorithm, wherein the filtered rudder angle signals are as follows:
Figure FDA0002331369600000011
wherein, deltam-iFor the current sampling of the rudder angle signal deltamThe previous i-th rudder angle signal; lambda [ alpha ]m-iFor the weighting coefficient, the calculation method is as follows:
Figure FDA0002331369600000012
step 2: the rudder angle instruction is restricted;
in order to prevent the drift phenomenon of the air cushion landing boat in the sailing process, the rudder angle instruction is restrained by combining the current sailing speed and the current turning rate, and the specific restraint is as follows:
when delta is larger than or equal to deltamax(v, γ) when δ is δmax(v,γ);
When delta < deltamax(v, γ), δ is δ;
wherein, deltamax(v, γ) are maximum rudder angle safety limits on velocity v and heading angle γ;
and step 3: mean rudder angle command value after calculation restraint
Figure FDA0002331369600000013
Figure FDA0002331369600000014
Wherein N is a rudder angle time sequence; the smaller the N value is, the worse the stability increasing effect is; the larger the value of N, the larger the hysteresis; deltaiA rudder angle value corresponding to each time sequence;
and 4, step 4: mean value of rudder angle instruction
Figure FDA0002331369600000015
With a set rudder angle mean threshold value deltaconst1Comparing; if it is
Figure FDA0002331369600000016
Entering a heading keeping mode and adopting a PID control law
Figure FDA0002331369600000017
The resultant moment M required to be generated is obtained, and the expected rudder angle delta is obtained through inverse solution of a rudder modelc(ii) a Wherein Kp、KdAnd KIAre all PID parameters; psie=ψ-ψd,ψd=ψ1,ψ1For averaging rudder angle commands for the first time
Figure FDA0002331369600000018
With a set rudder angle mean threshold value deltaconst1Heading when comparing; if it is
Figure FDA0002331369600000019
The rudder angle command variance δ after the restraint is calculated2The variance delta of the rudder angle command2With a set rudder angle variance threshold deltaconst2Comparing; rudder angle command variance delta2The calculation method comprises the following steps:
Figure FDA00023313696000000110
the variance delta of the rudder angle instruction2With a set rudder angle variance threshold deltaconst2Comparing; if delta2<δconst2Then adopt the rudder angleMean value smoothing by taking
Figure FDA00023313696000000111
If delta2>δconst2Then adopting a slew rate maintaining mode and adopting a PID control law
Figure FDA00023313696000000112
The resultant moment M required to be generated is obtained, and the expected rudder angle delta is obtained through inverse solution of a rudder modelc
Wherein r iseIs the deviation of the slew rate, re=r-rd,rdAccording to
Figure FDA0002331369600000021
Obtaining;
and 5: combining safety limit constraint, adopting heading and slew rate stability augmentation control under automatic driving control, and further obtaining the expected rudder angle deltacAnd the tail flicking rudder angle is restrained, and the heading or the turning rate is automatically controlled.
CN201911337575.1A 2019-12-23 2019-12-23 Air cushion landing boat control method based on stability augmentation controller Active CN111026144B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911337575.1A CN111026144B (en) 2019-12-23 2019-12-23 Air cushion landing boat control method based on stability augmentation controller

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911337575.1A CN111026144B (en) 2019-12-23 2019-12-23 Air cushion landing boat control method based on stability augmentation controller

Publications (2)

Publication Number Publication Date
CN111026144A true CN111026144A (en) 2020-04-17
CN111026144B CN111026144B (en) 2022-04-05

Family

ID=70211691

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911337575.1A Active CN111026144B (en) 2019-12-23 2019-12-23 Air cushion landing boat control method based on stability augmentation controller

Country Status (1)

Country Link
CN (1) CN111026144B (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113076675A (en) * 2021-04-12 2021-07-06 中国电子科技集团公司第三十三研究所 Electromagnetic environment effect simulation design method for air cushion landing boat

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4676460A (en) * 1984-11-28 1987-06-30 The Boeing Company Longitudinal stability augmentation system and method
CN103407443A (en) * 2013-07-11 2013-11-27 哈尔滨工程大学 Hovercraft navigation safety coordination and control method
CN105204338A (en) * 2015-09-24 2015-12-30 哈尔滨工程大学 Track keeping control method for hovercraft with guiding module
CN105955269A (en) * 2016-05-12 2016-09-21 武汉理工大学 Fuzzy PID algorithm based ship course controller
CN109343343A (en) * 2018-09-19 2019-02-15 广州大学 Steering gear control system and method based on deep learning and deep neural network
CN209327875U (en) * 2018-12-05 2019-08-30 山东智翼航空科技有限公司 Unmanned ship rolling-course coordination stability augmentation control system

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4676460A (en) * 1984-11-28 1987-06-30 The Boeing Company Longitudinal stability augmentation system and method
CN103407443A (en) * 2013-07-11 2013-11-27 哈尔滨工程大学 Hovercraft navigation safety coordination and control method
CN105204338A (en) * 2015-09-24 2015-12-30 哈尔滨工程大学 Track keeping control method for hovercraft with guiding module
CN105955269A (en) * 2016-05-12 2016-09-21 武汉理工大学 Fuzzy PID algorithm based ship course controller
CN109343343A (en) * 2018-09-19 2019-02-15 广州大学 Steering gear control system and method based on deep learning and deep neural network
CN209327875U (en) * 2018-12-05 2019-08-30 山东智翼航空科技有限公司 Unmanned ship rolling-course coordination stability augmentation control system

Non-Patent Citations (10)

* Cited by examiner, † Cited by third party
Title
刘振业: "全垫升气垫船安全航行自抗扰控制策略研究", 《中国优秀博士学位论文全文数据库 工程科技Ⅱ辑》 *
卢军等: "全垫升气垫船4自由度操纵性", 《上海交通大学学报》 *
吴文海: "《飞行综合控制系统》", 30 November 2018, 西安交通大学出版社 *
孟小辉: "全垫升气垫船航向安全控制方法研究", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 *
尹国栓: "全垫升气垫船航向多模型控制方法研究", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 *
张丽娜: "全垫升气垫船安全航行控制方法研究", 《中国优秀博士学位论文全文数据库 工程科技Ⅱ辑》 *
张博: "气垫船安全航行运动预报与约束控制方法研究", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 *
李仲彬: "全垫升气垫船航迹向与速度控制方法研究", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 *
胡妍妍: "气垫船特有操纵装置在航向控制中的应用研究", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 *
陈光祥等: "基于反步法的全垫升气垫船航向增稳控制", 《自动化技术与应用》 *

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113076675A (en) * 2021-04-12 2021-07-06 中国电子科技集团公司第三十三研究所 Electromagnetic environment effect simulation design method for air cushion landing boat

Also Published As

Publication number Publication date
CN111026144B (en) 2022-04-05

Similar Documents

Publication Publication Date Title
Li et al. Design, analysis and experimental validation of a robust nonlinear path following controller for marine surface vessels
CN110716566B (en) Limited time trajectory tracking control method of under-actuated unmanned ship
CN104793625B (en) Dynamic anti-saturation pitch angle control method for autonomous underwater vehicle
CN113093804B (en) Unmanned ship formation control method and control system based on inversion sliding mode control
CN107966152B (en) Collision avoidance and path tracking guidance method with collision risk prediction mechanism
CN110618611A (en) Unmanned ship trajectory tracking safety control method based on slew rate constraint
CN113156965B (en) Hovercraft high-speed rotation control method based on longitudinal speed planning
CN106292294B (en) Shipborne UAV auto landing on deck control device based on model reference self-adapting control
CN113467231B (en) Unmanned ship path tracking method based on sideslip compensation ILOS guidance law
CN112180972B (en) Unmanned aerial vehicle route determining method based on front wheel steering technology
EP2951656A2 (en) Stabilized directional control systems and methods
CN107323457B (en) A kind of shared rotating direction control method of man-machine coordination
CN110333658A (en) A kind of underactuated surface vessel course heading control method compensated with input constraint and drift angle
CN106292293A (en) The self adaptation auto landing on deck of the unmanned carrier-borne aircraft of a kind of fixed-wing guides control system
CN111026144B (en) Air cushion landing boat control method based on stability augmentation controller
EP3241085A1 (en) Proactive directional control systems and methods
CN106681352A (en) Underwater robot control method of rotatable rudder propeller
CN113867352A (en) Method for tracking path of air cushion vehicle
CN116048090A (en) Sail navigation aid ship path tracking control method with energy consumption optimization effect
CN112433534A (en) Flying wing unmanned aerial vehicle semi-rolling reverse maneuvering flight control method
CN117707162A (en) Unmanned sailing boat dynamic event triggering control method based on improved LVS guidance
CN106406096B (en) A kind of coupling suitable for the horizontal sidestep maneuver of aircraft utilizes control method for coordinating
CN113212538B (en) Method and terminal for autonomously correcting direction of remote-control unmanned vehicle
CN114609905A (en) Ship formation event trigger control method
CN105966566B (en) Hydrofoil catamaran course heel control method and device

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant