CN105197004A - System and method for hovercraft docking control based on laser range finder - Google Patents

System and method for hovercraft docking control based on laser range finder Download PDF

Info

Publication number
CN105197004A
CN105197004A CN201510616184.9A CN201510616184A CN105197004A CN 105197004 A CN105197004 A CN 105197004A CN 201510616184 A CN201510616184 A CN 201510616184A CN 105197004 A CN105197004 A CN 105197004A
Authority
CN
China
Prior art keywords
deviation
controller
hovercraft
rudder
heading
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.)
Pending
Application number
CN201510616184.9A
Other languages
Chinese (zh)
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 CN201510616184.9A priority Critical patent/CN105197004A/en
Publication of CN105197004A publication Critical patent/CN105197004A/en
Pending legal-status Critical Current

Links

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开了一种基于激光测距仪的气垫船进坞控制系统及控制方法。包括罗经、激光测距仪、比较器、控制器、空气舵和侧风门;罗经采集气垫船当前时刻的航向角传送给比较器;激光测距仪采集气垫船当前时刻的左右距离传送给比较器;比较器将接收的航向角与指令航向角进行比较得到航向偏差,将接收的左右距离进行比较得到位置偏差,将航向偏差和位置偏差传送给控制器;控制器包括航向控制器和位置横移控制器,航向控制器根据接收的航向偏差输出舵角指令传送给空气舵,调节空气舵舵角,位置横移控制器根据接收的位置偏差输出侧风门开闭指令传送给侧风门,控制侧风门的开闭。本发明能够提高操控水平和航行稳定性。

The invention discloses a control system and a control method for an air cushion vehicle docking based on a laser range finder. Including compass, laser rangefinder, comparator, controller, air rudder and side damper; the compass collects the current heading angle of the hovercraft and sends it to the comparator; the laser rangefinder collects the current left and right distance of the hovercraft and sends it to the comparator; The controller compares the received heading angle with the commanded heading angle to obtain the heading deviation, compares the received left and right distances to obtain the position deviation, and transmits the heading deviation and position deviation to the controller; the controller includes a heading controller and a position traverse controller , the heading controller outputs the rudder angle command according to the received heading deviation and sends it to the air rudder to adjust the air rudder rudder angle, and the position sway controller outputs the side air door opening and closing command according to the received position deviation and sends it to the side air door to control the opening of the side air door close. The invention can improve the control level and sailing stability.

Description

一种基于激光测距仪的气垫船进坞控制系统及控制方法A hovercraft docking control system and control method based on laser range finder

技术领域technical field

本发明属于气垫船的运动控制领域,尤其涉及一种基于激光测距仪的气垫船进坞控制系统及控制方法。The invention belongs to the field of motion control of hovercraft, and in particular relates to a control system and method for docking an hovercraft based on a laser range finder.

背景技术Background technique

气垫船的操纵性极差,由于静压力的支撑,悬浮在水面(地面),航行状态受外界环境影响极大,很容易发生侧滑和高速回转,稳定性极差。经过几十年的发展气垫船由最早的人工操纵到现在的自动驾控,提高了气垫船的操控水平、降低操纵难度、减轻驾驶人员的工作强度、提高了气垫船航行的安全性。The maneuverability of the hovercraft is extremely poor. Due to the support of static pressure, it is suspended on the water surface (ground). The navigation state is greatly affected by the external environment, and it is prone to sideslip and high-speed rotation, and its stability is extremely poor. After decades of development, the hovercraft has changed from the earliest manual control to the current automatic control, which has improved the control level of the hovercraft, reduced the difficulty of manipulation, reduced the work intensity of the driver, and improved the safety of the hovercraft.

随着气垫艇突出地位不断加强,气垫艇的保养维修也越来越受到重视,气垫艇进坞就是一项必不可少的步骤。保证气垫艇快速安全进坞,可以提高气垫艇的经济效益。As the prominent position of hovercraft continues to strengthen, more and more attention is paid to the maintenance and repair of hovercraft, and docking of hovercraft is an essential step. Ensuring the fast and safe docking of the hovercraft can improve the economic benefits of the hovercraft.

美、俄、英等国家相继开发研制了气垫船综合驾控系统。美国的LCAC等气垫船均装备了具有协调控制方式的自动驾控系统。俄罗斯在气垫船控制系统方面有丰富的理论及实际经验,20世纪90年代开发出了“黄橄榄石-32M”型气垫船协调运动控制系统,该型气垫船协调运动控制系统已经装备在“欧洲野牛号”大型气垫登陆艇上。但以上系统均没有提到气垫船的进坞控制,也没有见到相关的公开文献。Countries such as the United States, Russia, and the United Kingdom have successively developed integrated driving and control systems for hovercraft. Hovercraft such as LCAC in the United States are equipped with automatic driving control systems with coordinated control methods. Russia has rich theoretical and practical experience in hovercraft control systems. In the 1990s, it developed the "Yellow Peridot-32M" hovercraft coordinated motion control system. This type of hovercraft coordinated motion control system has been equipped on the "European Bison" On a large air cushion landing craft. But above-mentioned systems all do not mention the docking control of hovercraft, also do not see relevant open literature.

发明内容Contents of the invention

本发明的目的是提供一种能够减少时间和燃料损耗的,基于激光测距仪的气垫船进坞控制系统。本发明的目的还包括提供一种能够提高操控水平和航行稳定性的,基于激光测距仪的气垫船进坞控制方法。The object of the present invention is to provide a docking control system for hovercraft based on a laser rangefinder that can reduce time and fuel consumption. The object of the present invention also includes providing a method for controlling the docking of the hovercraft based on a laser range finder, which can improve the control level and navigation stability.

一种基于激光测距仪的气垫船进坞控制系统,包括罗经、激光测距仪、比较器、控制器、空气舵和侧风门;A hovercraft docking control system based on a laser range finder, including a compass, a laser range finder, a comparator, a controller, an air rudder and a side air door;

罗经采集气垫船当前时刻的航向角传送给比较器;The compass collects the heading angle of the hovercraft at the current moment and sends it to the comparator;

激光测距仪采集气垫船当前时刻的左右距离传送给比较器;The laser range finder collects the left and right distance of the hovercraft at the current moment and sends it to the comparator;

比较器将接收的航向角与指令航向角进行比较得到航向偏差,将接收的左右距离进行比较得到位置偏差,将航向偏差和位置偏差传送给控制器;The comparator compares the received heading angle with the commanded heading angle to obtain the heading deviation, compares the received left and right distances to obtain the position deviation, and transmits the heading deviation and position deviation to the controller;

控制器包括航向控制器和位置横移控制器,航向控制器根据接收的航向偏差输出舵角指令传送给空气舵,调节空气舵舵角,位置横移控制器根据接收的位置偏差输出侧风门开闭指令传送给侧风门,控制侧风门的开闭。The controller includes a course controller and a position traverse controller. The course controller outputs the rudder angle command according to the received course deviation and sends it to the air rudder to adjust the air rudder angle. The position traverse controller outputs the side air door opening according to the received position deviation. The closing command is sent to the side air door to control the opening and closing of the side air door.

一种基于激光测距仪的气垫船进坞控制方法,包括以下步骤,A kind of hovercraft docking control method based on laser range finder, comprises the following steps,

步骤一:罗经采集气垫船当前时刻的航向角,激光测距仪采集气垫船当前时刻的左右距离;Step 1: The compass collects the heading angle of the hovercraft at the current moment, and the laser rangefinder collects the left and right distances of the hovercraft at the current moment;

步骤二:比较器将当前时刻的航向角与指令航向角进行比较得到航向偏差,接收的左右距离进行比较得到位置偏差;Step 2: The comparator compares the current heading angle with the command heading angle to obtain the heading deviation, and compares the received left and right distances to obtain the position deviation;

步骤三:航向控制器接收航向偏差,采用神经网络滑膜控制方法,输出舵角指令;位置横移控制器接收位置偏差,采用逻辑判断方法,得到侧风门开闭指令;Step 3: The course controller receives the course deviation, adopts the neural network synovial film control method, and outputs the rudder angle command; the position sway controller receives the position deviation, and adopts the logic judgment method to obtain the side air door opening and closing command;

步骤四:空气舵根据接收的舵角指令改变舵角,改变气垫船所受力矩,实现航向控制,侧风门根据接收的开闭指令进行开闭操作,实现气垫船的横向移动。Step 4: The air rudder changes the rudder angle according to the received rudder angle command, changes the torque on the hovercraft, and realizes course control, and the side damper performs opening and closing operations according to the received opening and closing commands, so as to realize the lateral movement of the hovercraft.

本发明一种基于激光测距仪的气垫船进坞控制方法,还可以包括:A method for controlling the docking of a hovercraft based on a laser range finder in the present invention may also include:

1、神经网络滑膜控制方法中控制律为:1. The control law in the neural network synovium control method is:

uu == -- bb -- 11 [[ ff (( xx )) ++ ββ qq pp ee 22 22 -- pp qq (( 11 ++ γγ ++ 11 αα || || ee 11 || || γγ )) ++ ll ^^ gg ++ ηη sgnsgn (( sthe s )) -- xx ···· dd ]]

其中,e1为航向偏差,e2为航向偏差的变化率,α,β,γ>0为常数,p、q为正奇数,且满足1<p/q<2,为神经网络输出值,lg为控制律的切换增益,η>0为参数,f(x)为气垫船所受部分执行机构的力。Among them, e 1 is the heading deviation, e 2 is the change rate of the heading deviation, α, β, γ>0 are constants, p, q are positive odd numbers, and satisfy 1<p/q<2, is the output value of the neural network, lg is the switching gain of the control law, η>0 is the parameter, f(x) is the force of the actuator on the hovercraft.

2、逻辑判断方法为:当位置偏差为正值开启右侧侧风门,当位置偏差为负值开启左侧侧风门。2. The logical judgment method is: when the position deviation is positive, open the right side damper, and when the position deviation is negative, open the left side damper.

有益效果:Beneficial effect:

气垫船进坞是一项高难度的任务,在本控制方法的辅助下可以更快速准确的完成任务,减少时间和燃料的损耗,减轻驾驶员的精神压力,增强气垫船的可操纵性,不但能达到良好的控制效果,充分利用气垫船的操纵装置,提高气垫船的航行安全性。Docking of a hovercraft is a difficult task. With the assistance of this control method, the task can be completed more quickly and accurately, reducing time and fuel consumption, reducing the driver's mental pressure, and enhancing the maneuverability of the hovercraft. Good control effect, make full use of the control device of the hovercraft, and improve the navigation safety of the hovercraft.

附图说明Description of drawings

图1气垫船进坞控制方法原理框图;The principle block diagram of the control method for docking of the hovercraft of Fig. 1;

图2气垫船进坞控制方法程序流程图;Fig. 2 hovercraft docking control method program flow chart;

图3气垫船进坞控制方法控制器原理框图;Fig. 3 block diagram of controller principle of air cushion vehicle docking control method;

图4气垫船进坞控制方法航向控制器原理框图;Fig. 4 principle block diagram of heading controller of hovercraft docking control method;

图5气垫船进坞控制方法横移控制原理框图;Figure 5 is a block diagram of the principle block diagram of the traversing control of the hovercraft docking control method;

图6气垫船进坞控制方法航向控制仿真图;Fig. 6 simulation diagram of heading control of hovercraft docking control method;

图7气垫船的激光测距仪测量左右距离示意图;图7(a)气垫船位于中心线上时左右距离示意图,图7(b)气垫船平行位于中心线一侧时左右距离示意图,图7(c)气垫船艏向偏离中心线时左右距离示意图。Figure 7 is a schematic diagram of the left-right distance measured by the laser range finder of the hovercraft; Figure 7(a) is a schematic diagram of the left-right distance when the hovercraft is on the center line; Figure 7(b) is a schematic diagram of the left-right distance when the hovercraft is parallel to one side of the center line; Figure 7(c) Schematic diagram of the left and right distances when the hovercraft heading deviates from the center line.

图8本发明RBF神经网结构示意图。Fig. 8 is a schematic diagram of the structure of the RBF neural network of the present invention.

具体实施方式Detailed ways

下面将结合附图对本发明做进一步详细说明。The present invention will be described in further detail below in conjunction with the accompanying drawings.

本发明提出了一种基于激光测距仪的气垫船进坞控制方法,目的在于实现气垫船进坞控制,能够减轻驾驶人员的工作强度和精神负担,提高操控水平和航行稳定性。The invention proposes a method for controlling the docking of a hovercraft based on a laser rangefinder, with the purpose of realizing the docking control of the hovercraft, reducing the work intensity and mental burden of the driver, and improving the control level and navigation stability.

本发明所提出的气垫船进坞控制方法的原理如图1所示,过程如下:The principle of the hovercraft docking control method proposed by the present invention is as shown in Figure 1, and the process is as follows:

1.数据采集,根据罗经和激光测距仪计算出当前时刻的航向角和横向位置状态;1. Data collection, calculate the heading angle and lateral position status at the current moment according to the compass and laser range finder;

2.比较器,把数据采集模块得到航向与指令航向进行比较得到航向偏差,将激光测距仪得到的d1,d2进行比较得到位置偏差;2. The comparator, which compares the heading obtained by the data acquisition module with the command heading to obtain the heading deviation, and compares the d 1 and d 2 obtained by the laser range finder to obtain the position deviation;

3.控制器,根据航向偏差计算得到控制舵角指令,发送给空气舵系统,根据位置偏差得到侧风门控制信息,发送给开关控制装置,如图3所示。3. The controller calculates the rudder angle command according to the course deviation, sends it to the air rudder system, obtains the side air door control information according to the position deviation, and sends it to the switch control device, as shown in Figure 3.

4.空气舵舵角改变,使得气垫船所受力矩改变,从而达到航向控制,侧风门使气垫船得到横向的力使气垫船完成横移运动。4. The change of the rudder angle of the air rudder makes the moment of the hovercraft change, so as to achieve the course control, and the side air door makes the hovercraft get a lateral force to complete the lateral movement of the hovercraft.

本发明公开了一种基于激光测距仪的气垫船进坞控制方法,是一种由激光测距仪和罗经数据采集、比较器和控制器组成的气垫船的进坞控制方法。激光测距仪给出当前气垫船进坞左右的位置距离信息,罗经给出气垫艇的实际航向角。比较器进行当前航向和指令航向的比较得到航向偏差并且得到左右距离的位置偏差,判断出气垫船当前的位置状态。控制器根据位置状态输出控制指令给空气舵和侧风门,调整当前航向和左右距离,使气垫船沿中心线完成进坞任务。本发明通过自动调节空气舵可实现气垫船航向的控制,通过调节侧风门可以实现气垫船的横向移动控制,不但能改善气垫船的机动性,还可以提高气垫船的操控水平、降低操纵人员的工作强度和精神负担,降低了气垫船进坞任务的难度起到了较好的控制效果。The invention discloses a docking control method of an hovercraft based on a laser rangefinder, which is a docking control method of the hovercraft composed of a laser rangefinder, compass data acquisition, a comparator and a controller. The laser rangefinder gives the position and distance information of the current hovercraft docking, and the compass gives the actual heading angle of the hovercraft. The comparator compares the current course with the command course to obtain the course deviation and the position deviation of the left and right distances, and judges the current position state of the hovercraft. The controller outputs control commands to the air rudder and side air door according to the position state, adjusts the current course and the left and right distance, so that the hovercraft completes the docking task along the center line. The present invention can realize the control of the course of the hovercraft by automatically adjusting the air rudder, and can realize the lateral movement control of the hovercraft by adjusting the side damper, which can not only improve the maneuverability of the hovercraft, but also improve the control level of the hovercraft and reduce the working intensity and spirit of the operator burden, reducing the difficulty of the hovercraft docking task and playing a better control effect.

气垫船进坞控制方法,主要包括数据采集、比较器和控制器。数据采集实现当前位置和航向信息的采集,比较器进行航向比较和左右位置比较得到航向偏差和位置偏差,控制器解算控制指令。下面对本发明做几点说明。The method for controlling the docking of the hovercraft mainly includes data acquisition, a comparator and a controller. Data acquisition realizes the collection of current position and heading information, the comparator performs heading comparison and left and right position comparison to obtain heading deviation and position deviation, and the controller solves the control command. The present invention is described a few times below.

1、包括数据的采集,通过罗经传感器测得当前气垫艇实际的航向角,通过激光测距仪测得当前气垫艇进坞的左右距离的位置信息。1. Including data collection, the actual heading angle of the current hovercraft is measured by the compass sensor, and the position information of the left and right distance of the current hovercraft docking is measured by the laser range finder.

2、包括一个控制器,控制器的输入为比较器输出的当前指令航向与当前实际航向的偏差和位置偏差,输出为舵角和侧风门的开启状态。2. It includes a controller. The input of the controller is the deviation and position deviation between the current command heading output by the comparator and the current actual heading, and the output is the rudder angle and the open state of the side air door.

3、航向控制方法采用神经网络滑模控制,利用神经网络实时观测外界扰动,利用滑模控制使航向偏差趋近于零。位置的横移控制采用基本的逻辑判断,通过位置偏差控制侧风门的开启状态,使气垫船沿中心线完成进坞任务。3. The course control method adopts the neural network sliding mode control, uses the neural network to observe the external disturbance in real time, and uses the sliding mode control to make the course deviation close to zero. The lateral movement control of the position adopts basic logic judgment, and controls the opening state of the side air door through the position deviation, so that the hovercraft can complete the docking task along the center line.

4、航向控制器的输出指令为空气舵的舵角,输出给空气舵系统,通过调节空气舵舵角实现气垫船的航向控制;位置横移控制器的输出为侧风门开闭信息,通过控制侧风门的开闭实现气垫船的横向移动,使气垫船处于中心线位置。4. The output command of the course controller is the rudder angle of the air rudder, which is output to the air rudder system, and the course control of the hovercraft is realized by adjusting the rudder angle of the air rudder; The opening and closing of the damper realizes the lateral movement of the hovercraft, so that the hovercraft is at the centerline position.

气垫船进坞控制方法程序实现流程图如图2所示,步骤如下:The flow chart of the program implementation of the hovercraft docking control method is shown in Figure 2, and the steps are as follows:

1.读取当前时刻的实际航向角,比较器用当前时刻指令航向角与实际的航向角做差就得到了航向偏差,在实际的比较器实现中将航向偏差限定在-180度至180度之间,偏差为正表示船要向右转,反之船要向左转,当航向偏差为零时,进行步骤二。1. Read the actual heading angle at the current moment, and the comparator uses the difference between the command heading angle at the current moment and the actual heading angle to obtain the heading deviation. In the actual implementation of the comparator, the heading deviation is limited to -180 degrees to 180 degrees If the deviation is positive, it means that the ship will turn right, otherwise the ship will turn left. When the course deviation is zero, go to step 2.

2.根据激光测距仪测得的d1,d2进行比较得到位置偏差,如图7所示,气垫船通过侧风门控制进行横移运动;2. According to the d 1 and d 2 measured by the laser range finder, the position deviation is obtained by comparing, as shown in Figure 7, the hovercraft performs lateral movement through the control of the side air door;

航向控制器设计Heading Controller Design

航向控制器原理框图如图4所示,滑模变结构对非线性不确定性系统控制具有独特的效果,其本质是通过控制量的切换,使系统状态按照预定的“滑动模态”轨迹运动,从而保证系统在收到参数摄动和外界干扰具有不变性,对于不确定非线性系统,非奇异终端滑模控制器设计简单、鲁棒性好,响应速度快且具有终端滑模有限时间收敛的特点,相对于线性滑模具有更高的稳定性。The principle block diagram of the heading controller is shown in Figure 4. The sliding mode variable structure has a unique effect on the control of nonlinear uncertain systems. , so as to ensure that the system is invariant when receiving parameter perturbations and external disturbances. For uncertain nonlinear systems, the non-singular terminal sliding mode controller is simple in design, good in robustness, fast in response and has terminal sliding mode finite time convergence Compared with the linear sliding mold, it has higher stability.

对于气垫船系统,为进一步提高滑模控制系统的控制性能,并使系统到达平衡点的收敛速度进一步加快,选择非线性滑模面为:For the hovercraft system, in order to further improve the control performance of the sliding mode control system and further accelerate the convergence speed of the system reaching the equilibrium point, the nonlinear sliding mode surface is selected as:

sthe s == ee 11 ++ 11 &alpha;&alpha; || || ee 11 || || &gamma;&gamma; ++ 11 ++ 11 &beta;&beta; ee 22 pp qq

式中,e1为航向偏差,e2为航向偏差的变化率,α,β,γ>0为常数,p、q为正奇数,且满足1<p/q<2。In the formula, e 1 is the heading deviation, e 2 is the change rate of the heading deviation, α, β, γ>0 are constants, p, q are positive odd numbers, and satisfy 1<p/q<2.

设计控制律u使系统在有限时间内到达滑模面,并使滑模面上的跟踪误差在有限时间内收敛到零。控制律形式为:The control law u is designed to make the system reach the sliding mode surface in a finite time, and make the tracking error on the sliding mode surface converge to zero in a finite time. The form of the control law is:

uu == uu ee qq ++ uu sthe s ww == -- bb -- 11 &lsqb;&lsqb; ff (( xx )) ++ &beta;&beta; qq pp ee 22 22 -- pp qq (( 11 ++ &gamma;&gamma; ++ 11 &alpha;&alpha; || || ee 11 || || &gamma;&gamma; ++ 11 ++ (( lglg ++ &eta;&eta; sgnsgn (( sthe s )) )) -- xx &CenterDot;&CenterDot;&CenterDot;&CenterDot; dd )) &rsqb;&rsqb;

其中,ueq表示针对标称系统设计的等效控制,可根据计算得到,usw=-(lg+ηsgn(s))/b表示切换控制,目的是用来抵消系统中存在的不确定性,lg>0为外界扰动的上界值,η>0为设计参数,f(x)为气垫船所受部分执行机构的力等。where u eq represents the equivalent control designed for the nominal system, which can be calculated according to Calculated, u sw =-(lg+ηsgn(s))/b means switching control, the purpose is to offset the uncertainty existing in the system, lg>0 is the upper limit value of external disturbance, η>0 is the design parameter, f(x) is the force of some actuators on the hovercraft, etc.

在滑模控制中,lg为控制律的切换增益,lg的大小与不确定性扰动量有关,基于扰动量的不确定性,若lg取足够大来保证滑模到达条件,会带来较大的抖振,降低系统的稳定性且会增加系统的响应时间。所以为了消除此影响,保持滑模控制的稳定性同时降低滑模控制的抖振,本发明用RBF神经网络来调节切换增益lg。设计具有两个输入,两个隐含层节点和一个输出量的RBF神经网络,结构图如图8所示。In sliding mode control, lg is the switching gain of the control law, and the size of lg is related to the uncertainty disturbance. Based on the uncertainty of the disturbance, if lg is large enough to ensure the sliding mode arrival condition, it will bring a large Chattering reduces system stability and increases system response time. Therefore, in order to eliminate this influence, maintain the stability of the sliding mode control and reduce the chattering of the sliding mode control, the present invention uses the RBF neural network to adjust the switching gain lg. Design an RBF neural network with two inputs, two hidden layer nodes and one output, the structure diagram is shown in Figure 8.

则控制律可以表示为:Then the control law can be expressed as:

uu == -- bb -- 11 &lsqb;&lsqb; ff (( xx )) ++ &beta;&beta; qq pp ee 22 22 -- pp qq (( 11 ++ &gamma;&gamma; ++ 11 &alpha;&alpha; || || ee 11 || || &gamma;&gamma; )) ++ ll ^^ gg ++ &eta;&eta; sgnsgn (( sthe s )) -- xx &CenterDot;&CenterDot;&CenterDot;&CenterDot; dd &rsqb;&rsqb;

式中,为神经网络输出值。h1、h2为高斯函数,ω1,ω2为网络的权向量In the formula, Output values for the neural network. h 1 and h 2 are Gaussian functions, ω 1 and ω 2 are the weight vectors of the network

横向移动控制器设计Lateral Movement Controller Design

横向控制器通过控制侧风门来实现,控制原理框图如图5所示。通过激光测距仪采集的距离d1,d2进行比较得到位置偏差,通过位置偏差的正负值来控制左右两侧侧风门的开闭状态和开闭的大小,当偏差为正值开启右侧侧风门,当偏差为负值开启左侧侧风门。The lateral controller is realized by controlling the side air door, and the control principle block diagram is shown in Figure 5. The position deviation is obtained by comparing the distance d 1 and d 2 collected by the laser range finder, and the opening and closing status and opening and closing size of the left and right side air doors are controlled by the positive and negative values of the position deviation. When the deviation is positive, the right Side damper, when the deviation is negative, open the left side damper.

按照上面的方法,采用C++编程语言编制了气垫船航向控制程序,进行了试验室的半实物仿真实验。航向仿真图如图6所示。According to the above method, the course control program of the hovercraft is compiled by using C++ programming language, and the semi-physical simulation experiment of the laboratory is carried out. The heading simulation diagram is shown in Figure 6.

Claims (4)

1. to lie up a control system based on the air cushion vehicle of laser rangefinder, it is characterized in that: comprise compass, laser rangefinder, comparator, controller, air rudder and crosswind door;
The course angle that compass gathers air cushion vehicle current time sends comparator to;
The left and right distance that laser rangefinder gathers air cushion vehicle current time sends comparator to;
The course angle and instruction course angle of reception compares and obtains course deviation by comparator, the left and right distance of reception is compared and obtains position deviation, send course deviation and position deviation to controller;
Controller comprises the traversing controller of direction controller and position, direction controller exports rudder angle instruction according to the course deviation received and sends air rudder to, regulate air rudder rudder angle, the traversing controller in position sends crosswind door to according to the position deviation outgoing side air door opening and closing instruction received, and controls the opening and closing of crosswind door.
2. a control method for the control system that lies up based on the air cushion vehicle based on laser rangefinder according to claim 1, is characterized in that: comprise the following steps,
Step one: compass gathers the course angle of air cushion vehicle current time, laser rangefinder gathers the left and right distance of air cushion vehicle current time;
Step 2: the course angle and instruction course angle of current time compares and obtains course deviation by comparator, and the left and right distance of reception compares and obtains position deviation;
Step 3: direction controller receives course deviation, adopts neural network synovial membrane control method, exports rudder angle instruction; Position traversing controller receiving position deviation, adopts logic judging method, obtains crosswind door opening and closing instruction;
Step 4: air rudder changes rudder angle according to the rudder angle instruction received, changes air cushion vehicle Moment, realizes Heading control, and crosswind door carries out opening and closing operations according to the opening and closing instruction received, and realizes the transverse shifting of air cushion vehicle.
3. a kind of air cushion vehicle based on laser rangefinder according to claim 2 lies up control method, it is characterized in that: in described neural network synovial membrane control method, control law is:
u = - b - 1 &lsqb; f ( x ) + &beta; q p e 2 2 - p q ( 1 + &gamma; + 1 &alpha; | | e 1 | | &gamma; ) + l ^ g + &eta; sgn ( s ) - x &CenterDot;&CenterDot; d &rsqb;
Wherein, e 1for course deviation, e 2for the rate of change of course deviation, α, beta, gamma >0 are constant, and p, q are positive odd number, and meet 1<p/q<2, for neural network output valve, lg is the handoff gain of control law, and η >0 is the power of parameter, f (x) part actuating unit suffered by air cushion vehicle.
4. a kind of air cushion vehicle based on laser rangefinder according to claim 2 lies up control method, it is characterized in that: described logic judging method is: when position deviation is on the occasion of unlatching right side crosswind door, when position deviation is that negative value opens left side crosswind door.
CN201510616184.9A 2015-09-24 2015-09-24 System and method for hovercraft docking control based on laser range finder Pending CN105197004A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510616184.9A CN105197004A (en) 2015-09-24 2015-09-24 System and method for hovercraft docking control based on laser range finder

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510616184.9A CN105197004A (en) 2015-09-24 2015-09-24 System and method for hovercraft docking control based on laser range finder

Publications (1)

Publication Number Publication Date
CN105197004A true CN105197004A (en) 2015-12-30

Family

ID=54945087

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510616184.9A Pending CN105197004A (en) 2015-09-24 2015-09-24 System and method for hovercraft docking control based on laser range finder

Country Status (1)

Country Link
CN (1) CN105197004A (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107202991A (en) * 2016-09-08 2017-09-26 江苏科技大学 Ship model water surface site monitors the optic testing system and method for experiment in real time

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101109958A (en) * 2007-07-24 2008-01-23 浙江工业大学 Set the steering instrument for automatic heading correction
CN101320271A (en) * 2008-07-22 2008-12-10 中国船舶重工集团公司第七一○研究所 Ocean towing linear array high-precision course heading control method
CN103318167A (en) * 2013-07-05 2013-09-25 中国科学院合肥物质科学研究院 Intelligent air cushion transfer vehicle and control method thereof
CN103645632A (en) * 2013-11-22 2014-03-19 大连海联自动控制有限公司 A Model Reference Adaptive Control Method Based on Generalized Fuzzy CMAC
CN204473093U (en) * 2014-11-24 2015-07-15 中国人民解放军镇江船艇学院 Automation auxiliary device handled by a kind of ships and light boats

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101109958A (en) * 2007-07-24 2008-01-23 浙江工业大学 Set the steering instrument for automatic heading correction
CN101320271A (en) * 2008-07-22 2008-12-10 中国船舶重工集团公司第七一○研究所 Ocean towing linear array high-precision course heading control method
CN103318167A (en) * 2013-07-05 2013-09-25 中国科学院合肥物质科学研究院 Intelligent air cushion transfer vehicle and control method thereof
CN103645632A (en) * 2013-11-22 2014-03-19 大连海联自动控制有限公司 A Model Reference Adaptive Control Method Based on Generalized Fuzzy CMAC
CN204473093U (en) * 2014-11-24 2015-07-15 中国人民解放军镇江船艇学院 Automation auxiliary device handled by a kind of ships and light boats

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
丁福光等: "《全垫升气垫船PID-非奇异终端滑模的航迹保持》", 《新型工业化》 *

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107202991A (en) * 2016-09-08 2017-09-26 江苏科技大学 Ship model water surface site monitors the optic testing system and method for experiment in real time
CN107202991B (en) * 2016-09-08 2020-06-12 江苏科技大学 Optical test system and method for real-time monitoring experiment of ship model water surface position

Similar Documents

Publication Publication Date Title
CN102385316B (en) Deepening controlling method of underactuated automatic underwater vehicle based on neural network back stepping method
CN103955218B (en) A device and method for unmanned ship trajectory tracking control based on nonlinear control theory
CN107807663B (en) Formation keeping control method for unmanned aerial vehicles based on adaptive control
CN108594639B (en) A Reinforcement Learning-Based Track Tracking Control Method for a Cushioned Hovercraft
CN102768539B (en) AUV (autonomous underwater vehicle) three-dimension curve path tracking control method based on iteration
CN104898688B (en) The adaptive anti-interference System with Sliding Mode Controller of UUV four-degree-of-freedom dynamic positionings and control method
CN103592846B (en) Filtering backstepping ship movement control system based on self-adaption fuzzy estimator
CN104020774B (en) The attitude of flight vehicle fault tolerant control method redistributed based on dynamic control
CN106292287A (en) A kind of UUV path following method based on adaptive sliding-mode observer
CN102722177A (en) Autonomous underwater vehicle (AUV) three-dimensional straight path tracking control method with PID (Piping and Instruments Diagram) feedback gain
CN109976349A (en) Design method of path tracking guidance and control structure of constraint-containing unmanned ship
CN102880052A (en) Time scale function decomposition based hypersonic aircraft actuator saturation control method
CN108181806B (en) Active Disturbance Rejection Control Method for Position and Attitude of Space Robot Based on Sampling Output
CN105549611B (en) The flight path precise tracking method of the marine environment self-identifying of autonomous underwater robot
CN104691534B (en) A kind of aircushion vehicle revolution rate with guiding module keeps control method
CN109583144A (en) Dynamics optimization controller structure of unmanned marine vehicle and design method
CN106292294A (en) Shipborne UAV auto landing on deck based on model reference self-adapting control controls device
CN107563044A (en) The four rotor wing unmanned aerial vehicle path tracking control methods based on safety on line study
CN106681352A (en) Underwater robot control method of rotatable rudder propeller
CN108279563A (en) A kind of unmanned vehicle track following PID control method of speed adaptive
CN102866635A (en) Adaptive control method for discrete neural network of hypersonic aerocraft on basis of equivalence model
Liao et al. Research on disturbance rejection motion control method of USV for UUV recovery
CN105334854A (en) Decoupling control device and method for hovercraft course control and heeling control
CN105182975B (en) A kind of aircushion vehicle barrier-avoiding method based on improved artificial coordinating fields
CN107092256A (en) A kind of unmanned vehicle rotating direction control method

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
RJ01 Rejection of invention patent application after publication
RJ01 Rejection of invention patent application after publication

Application publication date: 20151230