CN108563234A - 一种水下无人机自平衡控制方法及*** - Google Patents
一种水下无人机自平衡控制方法及*** Download PDFInfo
- Publication number
- CN108563234A CN108563234A CN201810436252.7A CN201810436252A CN108563234A CN 108563234 A CN108563234 A CN 108563234A CN 201810436252 A CN201810436252 A CN 201810436252A CN 108563234 A CN108563234 A CN 108563234A
- Authority
- CN
- China
- Prior art keywords
- pid
- unmanned plane
- motion
- freedom
- thrust
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 29
- 230000033001 locomotion Effects 0.000 claims abstract description 78
- 239000011159 matrix material Substances 0.000 claims abstract description 16
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims abstract description 8
- 238000005096 rolling process Methods 0.000 claims description 12
- 230000003068 static effect Effects 0.000 claims description 11
- 238000006073 displacement reaction Methods 0.000 claims description 10
- 230000010354 integration Effects 0.000 claims description 7
- 238000000926 separation method Methods 0.000 claims description 6
- 230000009471 action Effects 0.000 claims description 5
- 230000000694 effects Effects 0.000 claims description 5
- 230000006641 stabilisation Effects 0.000 claims description 4
- 238000011105 stabilization Methods 0.000 claims description 4
- 229920006395 saturated elastomer Polymers 0.000 claims 1
- 238000011217 control strategy Methods 0.000 abstract description 7
- 230000008878 coupling Effects 0.000 abstract description 5
- 238000010168 coupling process Methods 0.000 abstract description 5
- 238000005859 coupling reaction Methods 0.000 abstract description 5
- 238000001514 detection method Methods 0.000 abstract description 2
- 230000001133 acceleration Effects 0.000 description 5
- 238000000465 moulding Methods 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 3
- 241000208340 Araliaceae Species 0.000 description 2
- 235000005035 Panax pseudoginseng ssp. pseudoginseng Nutrition 0.000 description 2
- 235000003140 Panax quinquefolius Nutrition 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 235000008434 ginseng Nutrition 0.000 description 2
- 206010044565 Tremor Diseases 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 230000033228 biological regulation Effects 0.000 description 1
- 230000004069 differentiation Effects 0.000 description 1
- 239000004744 fabric Substances 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 239000000725 suspension Substances 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0875—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted to water vehicles
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
- B63B—SHIPS OR OTHER WATERBORNE VESSELS; EQUIPMENT FOR SHIPPING
- B63B39/00—Equipment to decrease pitch, roll, or like unwanted vessel movements; Apparatus for indicating vessel attitude
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
- B63B—SHIPS OR OTHER WATERBORNE VESSELS; EQUIPMENT FOR SHIPPING
- B63B79/00—Monitoring properties or operating parameters of vessels in operation
- B63B79/40—Monitoring properties or operating parameters of vessels in operation for controlling the operation of vessels, e.g. monitoring their speed, routing or maintenance schedules
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
- B63G—OFFENSIVE OR DEFENSIVE ARRANGEMENTS ON VESSELS; MINE-LAYING; MINE-SWEEPING; SUBMARINES; AIRCRAFT CARRIERS
- B63G8/00—Underwater vessels, e.g. submarines; Equipment specially adapted therefor
- B63G8/001—Underwater vessels adapted for special purposes, e.g. unmanned underwater vessels; Equipment specially adapted therefor, e.g. docking stations
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
- B63G—OFFENSIVE OR DEFENSIVE ARRANGEMENTS ON VESSELS; MINE-LAYING; MINE-SWEEPING; SUBMARINES; AIRCRAFT CARRIERS
- B63G8/00—Underwater vessels, e.g. submarines; Equipment specially adapted therefor
- B63G8/08—Propulsion
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
- B63G—OFFENSIVE OR DEFENSIVE ARRANGEMENTS ON VESSELS; MINE-LAYING; MINE-SWEEPING; SUBMARINES; AIRCRAFT CARRIERS
- B63G8/00—Underwater vessels, e.g. submarines; Equipment specially adapted therefor
- B63G8/14—Control of attitude or depth
- B63G8/16—Control of attitude or depth by direct use of propellers or jets
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B11/00—Automatic controllers
- G05B11/01—Automatic controllers electric
- G05B11/36—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
- G05B11/42—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential for obtaining a characteristic which is both proportional and time-dependent, e.g. P. I., P. I. D.
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
- B63G—OFFENSIVE OR DEFENSIVE ARRANGEMENTS ON VESSELS; MINE-LAYING; MINE-SWEEPING; SUBMARINES; AIRCRAFT CARRIERS
- B63G8/00—Underwater vessels, e.g. submarines; Equipment specially adapted therefor
- B63G8/001—Underwater vessels adapted for special purposes, e.g. unmanned underwater vessels; Equipment specially adapted therefor, e.g. docking stations
- B63G2008/002—Underwater vessels adapted for special purposes, e.g. unmanned underwater vessels; Equipment specially adapted therefor, e.g. docking stations unmanned
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
- B63G—OFFENSIVE OR DEFENSIVE ARRANGEMENTS ON VESSELS; MINE-LAYING; MINE-SWEEPING; SUBMARINES; AIRCRAFT CARRIERS
- B63G8/00—Underwater vessels, e.g. submarines; Equipment specially adapted therefor
- B63G8/001—Underwater vessels adapted for special purposes, e.g. unmanned underwater vessels; Equipment specially adapted therefor, e.g. docking stations
- B63G2008/002—Underwater vessels adapted for special purposes, e.g. unmanned underwater vessels; Equipment specially adapted therefor, e.g. docking stations unmanned
- B63G2008/004—Underwater vessels adapted for special purposes, e.g. unmanned underwater vessels; Equipment specially adapted therefor, e.g. docking stations unmanned autonomously operating
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Ocean & Marine Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本申请属于水下探测机器人技术领域,特别涉及一种水下无人机自平衡控制方法及***。本申请的水下无人机自平衡控制方法包括:步骤a:在水下无人机上设置至少一个可正反转螺旋桨推进器;步骤b:将水下无人机所受的作用力通过运动自由度控制模型转化为至少一个运动自由度上的合力,其中,运动自由度对应的是可测量的运动控制量参数;步骤c:根据每个运动自由度设计一个对应的子PID控制器;步骤d:通过推力分配矩阵计算至少一个可正反转螺旋桨推进器分别需要的推力。本申请实施例的水下无人机自平衡控制方法及***可以非常平稳和快速的完成水下无人机在5个自由度上的闭环运动控制,控制***耦合度高、控制算法易于实现、控制策略简单高效。
Description
技术领域
本申请属于水下探测机器人技术领域,特别涉及一种水下无人机自平衡控制方法及***。
背景技术
PID运动控制技术和算法是一种基于反馈的概念以减少不确定性的控制方法与策略,它是目前在工程实际中应用最为广泛的控制调节器。PID控制器(比例-积分-微分控制器)是一个在工业控制应用中常见的反馈回路部件,由比例单元P、积分单元I和微分单元D组成。PID控制的基础是比例控制,积分控制可消除稳态误差,但可能增加超调;微分控制可加快大惯性***响应速度以及减弱超调趋势。目前水下机器人运动控制中,多数采用普通PID或PI控制器,且一般主要针对单自由度方向上的闭环控制,其中包括定深PID控制器,负责稳定保持在特定深度上的闭环控制策略;定向PID控制器,负责水下无人机保持特定航向航行的闭环控制策略;姿态稳定PID控制器则负责维持水下无人机机器姿态平稳的闭环控制。
在目前的水下无人机闭环控制策略中,定深、定向和姿态稳定PID控制器都是单独功能的控制策略,一般情况下各个PID控制器单独工作,根据具体需求启用1到2个PID控制器,因此很难完成完全的机体自平衡悬浮控制;同时单独控制器所控制的并不是所有的推进器,可能是其中部分的推进器,在结合终端设备给出的对其他推进器的控制信号时,PID的闭环控制效果可能并不明显和有效。
发明内容
本申请提供了一种水下无人机自平衡控制方法及***,旨在至少在一定程度上解决现有技术中的上述技术问题之一。
为了解决上述问题,本申请提供了如下技术方案:
一种水下无人机自平衡控制方法,包括以下步骤:
步骤a:在水下无人机上设置至少一个可正反转螺旋桨推进器;
步骤b:将水下无人机所受的作用力通过运动自由度控制模型转化为至少一个运动自由度上的合力,其中,运动自由度对应的是可测量的运动控制量参数;
步骤c:根据每个运动自由度设计一个对应的子PID控制器;
步骤d:通过推力分配矩阵计算至少一个可正反转螺旋桨推进器分别需要的推力。
本申请实施例采取的技术方案还包括:在所述步骤a中,设置6个可正反转螺旋桨推进器,4个可正反转螺旋桨推进器提供完全垂直于本体平面的垂直推力,2个可正反转螺旋桨推进器提供完全平行于本体平面的水平推力。
本申请实施例采取的技术方案还包括:在所述步骤b中,所述6个推进器的推力转化为5个运动自由度上的合力,5个运动自由度对应的是可以测量的5个运动控制量参数,所述运动控制量参数包括升沉-深度、纵倾-纵倾角度、横摇-横摇角度、平移-水平位移和转艏-航向角度。
本申请实施例采取的技术方案还包括:在所述步骤c中,所述子PID控制器包括:定位PID、定深PID、定向PID、横摇稳定PID和纵倾稳定PID。
本申请实施例采取的技术方案还包括:所述子PID控制器采用增量式PID或结合积分分离的普通PID,即当被控量与设定值的偏差较大时,取消积分作用,减少较大的静差带来过大的反馈控制;当被控量接近给定值时,引入积分控制,以消除静差,提高控制精度。
本申请实施例采取的技术方案还包括:所述步骤d还包括:建立整体PID控制***,提供PID控制器调用逻辑,具体为:所述定深PID、定向PID、横摇稳定PID和纵倾稳定PID默认共同启动和工作,通过运行状态中的子PID控制器反馈输出的合力始终要与操控终端指令要求的力合并,成为最终的水下无人机刚体运动所需合力。
本申请实施例采取的技术方案还包括:所述步骤d还包括:对每个推力做饱和限制,不能超过极限。
本申请实施例采取的又一技术方案为:一种水下无人机自平衡控制***,包括:可正反转螺旋桨推进器、运动自由度控制模块、子PID控制器和推力分配矩阵计算模块,所述可正反转螺旋桨推进器用于提供推力,驱动水下无人机;所述运动自由度控制模块用于将水下无人机所受的作用力通过运动自由度控制模型转化为至少一个运动自由度上的合力,其中,运动自由度对应的是可测量的运动控制量参数;所述子PID控制器与每个运动自由度相对应;所述推力分配矩阵计算模块用于计算可正反转螺旋桨推进器需要的推力。
本申请实施例采取的技术方案还包括:所述可正反转螺旋桨推进器为6个,4个可正反转螺旋桨推进器提供完全垂直于本体平面的垂直推力,2个可正反转螺旋桨推进器提供完全平行于本体平面的水平推力;所述运动自由度控制模块将6个推进器的推力转化为5个运动自由度上的合力,5个运动自由度对应的是可以测量的5个运动控制量参数,所述运动控制量参数包括升沉-深度、纵倾-纵倾角度、横摇-横摇角度、平移-水平位移和转艏-航向角度。
本申请实施例采取的技术方案还包括:所述的水下无人机自平衡控制***还包括:推力饱和限制模块,用于对每个推力做饱和限制,不能超过极限;所述子PID控制器包括:定位PID、定深PID、定向PID、横摇稳定PID和纵倾稳定PID,子PID控制器采用增量式PID或结合积分分离的普通PID,即当被控量与设定值的偏差较大时,取消积分作用,减少较大的静差带来过大的反馈控制;当被控量接近给定值时,引入积分控制,以消除静差,提高控制精度。
相对于现有技术,本申请实施例产生的有益效果在于:本申请实施例的水下无人机自平衡控制方法及***通过六推水下无人机专用的姿态自平衡闭环运动控制器进行水下无人机的控制,易于编程实现并方便调试修改,可通过水面控制终端的软件中实现该PID控制器的应用,且对水下无人机的硬件***不造成过多的负担和过高的要求;本申请实施例的水下无人机自平衡控制方法及***可以非常平稳和快速的完成水下无人机在5个自由度上的闭环运动控制,控制***耦合度高、控制算法易于实现、控制策略简单高效。
附图说明
图1是本申请实施例的水下无人机自平衡控制方法的流程图;
图2是本申请实施例的水下无人机推力分布和5自由度运动显示图;
图3是本申请实施例的水下无人机自平衡控制***的结构示意图。
具体实施方式
为了使本申请的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本申请进行进一步详细说明。应当理解,此处所描述的具体实施例仅用以解释本申请,并不用于限定本申请。
请参阅图1,是本申请实施例的水下无人机自平衡控制方法的流程图。本申请实施例的水下无人机自平衡控制方法包括以下步骤:
步骤100:在水下无人机上设置至少一个可正反转螺旋桨推进器;
在步骤100中,本申请实施例的水下无人机自平衡控制方法对水下无人机设置6个可正反转螺旋桨推进器,在力学模型中代表6个外力可对本体进行作用,其中,4个为完全垂直于本体平面的垂直推力,2个为完全平行于本体平面的水平推力。通过力学模型简化过程,可以将其简化为受6个外力作用的刚体结构。请一并参阅图2,图2为水下无人机推力分布和5自由度运动显示图。在图2中,4个垂直推力能够使水下无人机可进行升沉(沿Z轴)、纵倾(绕Y轴旋转)和横摇(绕X轴旋转)这三个自由度上的运动;2个水平推力使得水下无人机可进行平移(沿X轴)和转艏(绕Z轴)这两个自由度上的运动。
步骤200:将水下无人机所受的作用力通过运动自由度控制模型转化为至少一个运动自由度上的合力,其中,运动自由度对应的是可测量的运动控制量参数;
在本申请实施例的水下无人机自平衡控制方法中,水下无人机所受的六推作用力转化为在5个自由度方向上的控制模型,6个推进器的推力最终将转化为5个自由度上的合力。水下无人机的控制模型跟最初的力学模型之间存在转换关系,通过控制矩阵B将六推力学模型转换为5自由度控制模型:
由于5个运动自由度对应的是可以测量的5个运动控制量参数,5个运动控制量参数包括升沉-深度、纵倾-纵倾角度、横摇-横摇角度、平移-水平位移和转艏-航向角度,每个运动控制量参数分别与每个运动自由度单独相关,因此这样的5自由度运动控制模型非常便于后续模型的PID控制器设计。根据水下无人机工程需求和可实施性原则,对PID闭环自动反馈控制的设计也遵循实用性原则。
步骤300:根据每个运动自由度设计一个对应的子PID控制器;
在本申请实施例的水下无人机自平衡控制方法中,水下无人机可完成5自由度运动,对应每个自由度设计一个子PID控制器,避免建立过于复杂的需要考虑多个自由度的PID控制器。对应的子PID控制器包括:定位PID(或称为顶流PID):PID A,九轴传感器中的轴向加速度a_x积分为位移量,通过前后位移量变化ΔX反馈控制X轴方向的合力F_x。该PID控制器的反馈参数ΔX不容易准确获取,可以在需要加入悬停功能时考虑;定深PID:PID H,基于深度传感器深度信号,通过深度变化量ΔH反馈控制Z轴方向(深度)的合力F_z,PID H是常用且必需的控制器;定向PID:PID Z,基于磁罗经测得航向角,通过航向角变化量Δα反馈控制绕Z轴的力矩N_z,PID Z为常用PID控制器;横摇稳定PID:PID X,基于九轴传感器的横摇角,通过横摇角度变化量Δβ反馈控制绕X轴的力矩N_x;纵倾稳定PID:PID Y,基于九轴传感器的纵倾角,通过纵倾角度变化量Δγ反馈控制绕Y轴的力矩N_y。
一般的PID控制器,包括比例参数K_p,积分参数K_i和微分参数K_d。针对本申请实施例的PID控制器设计,反馈信号一般为深度、航向角、角度等位移量,而控制的5个自由度的合力都是跟线加速度、角加速度等成线性关系,因此起关键作用的为比例参数K_p,积分参数K_i,PID控制器的结构设计也主要以P I为主,微分参数K_d起到的作用有限。控制器采用增量式PID或结合积分分离的普通PID(当被控量与设定值的偏差较大时,取消积分作用,减少较大的静差带来过大的反馈控制;当被控量接近给定值时,引入积分控制,以消除静差,提高控制精度)的方法对PID进行控制。
步骤400:建立整体PID控制***,提供PID控制器调用逻辑,通过推力分配矩阵计算至少一个推进器分别需要的推力;
本申请实施例的建立整体PID控制***,提供PID控制器调用逻辑,首先考虑定深PID H、定向PID Z、横摇稳定PID X和纵倾稳定PID Y这4个PID控制器,定位PID A由于反馈参数的不稳定性暂时不以考虑。在水下无人机的“自平衡”模式,以上4个PID控制器默认共同启动和工作。通过运行状态中的PID控制器反馈输出的合力F_z1,N_z1,N_x1,N_y1始终要与操控终端指令要求的力F_x,F_z2,N_z2,N_x2,N_y2合并,成为最终的水下无人机刚体运动所需合力F_x,F_z=F_z1+F_z2,N_z=N_z1+N_z2,N_x=N_x1+N_x2,N_y=N_y1+N_y2;6个推进器的推力由合并后的力通过推力分配矩阵C分别求解得到。通过推力分配矩阵计算的是6个推进器分别需要的推力,因此本申请实施例的水下无人机自平衡控制***是耦合和连续的。
步骤500:对每个推力做饱和限制,不能超过极限。
请参阅图3,是本申请实施例的水下无人机自平衡控制***的结构示意图。本申请实施例的水下无人机自平衡控制***包括至少一个可正反转螺旋桨推进器、运动自由度控制模块、至少一个子PID控制器、推力分配矩阵计算模块和推力饱和限制模块。在本申请实施例的水下无人机自平衡控制***中,设置6个可正反转螺旋桨推进器,在力学模型中代表6个外力可对本体进行作用,其中,4个为完全垂直于本体平面的垂直推力,2个为完全平行于本体平面的水平推力。通过力学模型简化过程,可以将其简化为受6个外力作用的刚体结构。请一并参阅图2,图2为水下无人机推力分布和5自由度运动显示图。在图2中,4个垂直推力能够使水下无人机可进行升沉(沿Z轴)、纵倾(绕Y轴旋转)和横摇(绕X轴旋转)这三个自由度上的运动;2个水平推力使得水下无人机可进行平移(沿X轴)和转艏(绕Z轴)这两个自由度上的运动。运动自由度控制模块将水下无人机所受的作用力转化为至少一个运动自由度上的合力,其中,运动自由度对应的是可测量的运动控制量参数。在本申请实施例的水下无人机自平衡控制***中,水下无人机所受的六推作用力转化为在5个自由度方向上的控制模型,6个推进器的推力最终将转化为5个自由度上的合力。水下无人机的控制模型跟最初的力学模型之间存在转换关系,通过控制矩阵B将六推力学模型转换为5自由度控制模型:
由于5个运动自由度对应的是可以测量的5个运动控制量参数,5个运动控制量参数包括升沉-深度、纵倾-纵倾角度、横摇-横摇角度、平移-水平位移和转艏-航向角度,每个运动控制量参数分别与每个运动自由度单独相关,因此这样的5自由度运动控制模型非常便于后续模型的PID控制器设计。根据水下无人机工程需求和可实施性原则,对PID闭环自动反馈控制的设计也遵循实用性原则。子PID控制器用于完成各个方向上的自由度运动,对应的子PID控制器包括:定位PID(或称为顶流PID):PID A,九轴传感器中的轴向加速度a_x积分为位移量,通过前后位移量变化ΔX反馈控制X轴方向的合力F_x。该PID控制器的反馈参数ΔX不容易准确获取,可以在需要加入悬停功能时考虑;定深PID:PID H,基于深度传感器深度信号,通过深度变化量ΔH反馈控制Z轴方向(深度)的合力F_z。PID H是常用且必需的控制器;定向PID:PID Z,基于磁罗经测得航向角,通过航向角变化量Δα反馈控制绕Z轴的力矩N_z。PID Z为常用PID控制器;横摇稳定PID:PD X,基于九轴传感器的横摇角,通过横摇角度变化量Δβ反馈控制绕X轴的力矩N_x;纵倾稳定PID:PID Y,基于九轴传感器的纵倾角,通过纵倾角度变化量Δγ反馈控制绕Y轴的力矩N_y。一般的PID控制器,包括比例参数K_p,积分参数K_i和微分参数K_d。针对本申请实施例的PID控制器设计,反馈信号一般为深度、航向角、角度等位移量,而控制的5个自由度的合力都是跟线加速度、角加速度等成线性关系,因此起关键作用的为比例参数K_p,积分参数K_i,PID控制器的结构设计也主要以P I为主,微分参数K_d起到的作用有限。控制器采用增量式PID或结合积分分离的普通PID(当被控量与设定值的偏差较大时,取消积分作用,减少较大的静差带来过大的反馈控制;当被控量接近给定值时,引入积分控制,以消除静差,提高控制精度)的方法对PID进行控制。推力分配矩阵计算模块用于建立整体PID控制***,提供PID控制器调用逻辑,计算至少一个推进器分别需要的推力。本申请实施例的PID控制***,首先考虑定深PID H、定向PID Z、横摇稳定PID X和纵倾稳定PID Y这4个PID控制器,定位PID A由于反馈参数的不稳定性暂时不以考虑。在水下无人机的“自平衡”模式,以上4个PID控制器默认共同启动和工作。通过运行状态中的PID控制器反馈输出的合力F_z1,N_z1,N_x1,N_y1始终要与操控终端指令要求的力F_x,F_z2,N_z2,N_x2,N_y2合并,成为最终的水下无人机刚体运动所需合力F_x,F_z=F_z1+F_z2,N_z=N_z1+N_z2,N_x=N_x1+N_x2,N_y=N_y1+N_y2;6个推进器的推力由合并后的力通过推力分配矩阵C分别求解得到。通过推力分配矩阵计算的是6个推进器分别需要的推力,因此本申请实施例的水下无人机自平衡控制***是耦合和连续的。推力饱和限制模块用于对每个推力做饱和限制,不能超过极限。
本申请实施例的水下无人机自平衡控制方法和***通过六推水下无人机专用的姿态自平衡闭环运动控制器进行水下无人机的控制,易于编程实现并方便调试修改,可通过水面控制终端的软件中实现该PID控制器的应用,且对水下无人机的硬件***不造成过多的负担和过高的要求;本申请实施例的水下无人机自平衡控制方法和***可以非常平稳和快速的完成水下无人机在5个自由度上的闭环运动控制,控制***耦合度高、控制算法易于实现、控制策略简单高效。
对所公开的实施例的上述说明,使本领域专业技术人员能够实现或使用本申请。对这些实施例的多种修改对本领域的专业技术人员来说将是显而易见的,本文中所定义的一般原理可以在不脱离本申请的精神或范围的情况下,在其它实施例中实现。因此,本申请将不会被限制于本文所示的这些实施例,而是要符合与本文所公开的原理和新颖特点相一致的最宽的范围。
Claims (10)
1.一种水下无人机自平衡控制方法,其特征在于,包括以下步骤:
步骤a:在水下无人机上设置至少一个可正反转螺旋桨推进器;
步骤b:将水下无人机所受的作用力通过运动自由度控制模型转化为至少一个运动自由度上的合力,其中,运动自由度对应的是可测量的运动控制量参数;
步骤c:根据每个运动自由度设计一个对应的子PID控制器;
步骤d:通过推力分配矩阵计算至少一个可正反转螺旋桨推进器分别需要的推力。
2.根据权利要求1所述的水下无人机自平衡控制方法,其特征在于,在所述步骤a中,设置6个可正反转螺旋桨推进器,4个可正反转螺旋桨推进器提供完全垂直于本体平面的垂直推力,2个可正反转螺旋桨推进器提供完全平行于本体平面的水平推力。
3.根据权利要求2所述的水下无人机自平衡控制方法,其特征在于,在所述步骤b中,所述6个推进器的推力转化为5个运动自由度上的合力,5个运动自由度对应的是可以测量的5个运动控制量参数,所述运动控制量参数包括升沉-深度、纵倾-纵倾角度、横摇-横摇角度、平移-水平位移和转艏-航向角度。
4.根据权利要求3所述的水下无人机自平衡控制方法,其特征在于,在所述步骤c中,所述子PID控制器包括:定位PID、定深PID、定向PID、横摇稳定PID和纵倾稳定PID。
5.根据权利要求4所述的水下无人机自平衡控制方法,其特征在于,所述子PID控制器采用增量式PID或结合积分分离的普通PID,即当被控量与设定值的偏差较大时,取消积分作用,减少较大的静差带来过大的反馈控制;当被控量接近给定值时,引入积分控制,以消除静差,提高控制精度。
6.根据权利要求4或5所述的水下无人机自平衡控制方法,其特征在于,所述步骤d还包括:建立整体PID控制***,提供PID控制器调用逻辑,具体为:所述定深PID、定向PID、横摇稳定PID和纵倾稳定PID默认共同启动和工作,通过运行状态中的子PID控制器反馈输出的合力始终要与操控终端指令要求的力合并,成为最终的水下无人机刚体运动所需合力。
7.根据权利要求4或5所述的水下无人机自平衡控制方法,其特征在于,所述步骤d还包括:对每个推力做饱和限制,不能超过极限。
8.一种水下无人机自平衡控制***,其特征在于,包括:可正反转螺旋桨推进器、运动自由度控制模块、子PID控制器和推力分配矩阵计算模块,所述可正反转螺旋桨推进器用于提供推力,驱动水下无人机;所述运动自由度控制模块用于将水下无人机所受的作用力通过运动自由度控制模型转化为至少一个运动自由度上的合力,其中,运动自由度对应的是可测量的运动控制量参数;所述子PID控制器与每个运动自由度相对应;所述推力分配矩阵计算模块用于计算可正反转螺旋桨推进器需要的推力。
9.根据权利要求8所述的水下无人机自平衡控制***,其特征在于,所述可正反转螺旋桨推进器为6个,4个可正反转螺旋桨推进器提供完全垂直于本体平面的垂直推力,2个可正反转螺旋桨推进器提供完全平行于本体平面的水平推力;所述运动自由度控制模块将6个推进器的推力转化为5个运动自由度上的合力,5个运动自由度对应的是可以测量的5个运动控制量参数,所述运动控制量参数包括升沉-深度、纵倾-纵倾角度、横摇-横摇角度、平移-水平位移和转艏-航向角度。
10.根据权利要求9所述的水下无人机自平衡控制***,其特征在于,还包括:推力饱和限制模块,用于对每个推力做饱和限制,不能超过极限;所述子PID控制器包括:定位PID、定深PID、定向PID、横摇稳定PID和纵倾稳定PID,子PID控制器采用增量式PID或结合积分分离的普通PID,即当被控量与设定值的偏差较大时,取消积分作用,减少较大的静差带来过大的反馈控制;当被控量接近给定值时,引入积分控制,以消除静差,提高控制精度。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810436252.7A CN108563234A (zh) | 2018-05-09 | 2018-05-09 | 一种水下无人机自平衡控制方法及*** |
PCT/CN2018/112597 WO2019214173A1 (zh) | 2018-05-09 | 2018-10-30 | 一种水下无人机自平衡控制方法及*** |
US17/088,609 US20210047019A1 (en) | 2018-05-09 | 2020-11-04 | Self-balancing control method and system for an unmanned underwater vehicle |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810436252.7A CN108563234A (zh) | 2018-05-09 | 2018-05-09 | 一种水下无人机自平衡控制方法及*** |
Publications (1)
Publication Number | Publication Date |
---|---|
CN108563234A true CN108563234A (zh) | 2018-09-21 |
Family
ID=63538031
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810436252.7A Pending CN108563234A (zh) | 2018-05-09 | 2018-05-09 | 一种水下无人机自平衡控制方法及*** |
Country Status (3)
Country | Link |
---|---|
US (1) | US20210047019A1 (zh) |
CN (1) | CN108563234A (zh) |
WO (1) | WO2019214173A1 (zh) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110032208A (zh) * | 2019-05-20 | 2019-07-19 | 吉林大学 | 一种用于水下侦查与摄影无人机及其控制方法 |
CN110262565A (zh) * | 2019-05-28 | 2019-09-20 | 深圳市吉影科技有限公司 | 应用于水下六推无人机的目标跟踪运动控制方法及装置 |
WO2019214173A1 (zh) * | 2018-05-09 | 2019-11-14 | 深圳市吉影科技有限公司 | 一种水下无人机自平衡控制方法及*** |
CN111338206A (zh) * | 2020-04-23 | 2020-06-26 | 深圳市吉影科技有限公司 | 一种水下航行器的自动平衡方法及*** |
CN112033347A (zh) * | 2020-08-31 | 2020-12-04 | 中广核检测技术有限公司 | 一种水下遥控载具及其姿态检测方法 |
CN114030579A (zh) * | 2021-12-07 | 2022-02-11 | 杭州电子科技大学 | 一种无人船稳定控制方法及推进装置 |
CN115571309A (zh) * | 2022-11-25 | 2023-01-06 | 青州鑫聚隆装备制造有限公司 | 一种多功能智联的水下机器人控制方法及其控制*** |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110844028A (zh) * | 2019-11-29 | 2020-02-28 | 山东大学 | 一种用于深海着陆器落点区域及速度的调控装置及方法 |
CN112731797B (zh) * | 2020-12-10 | 2021-11-23 | 清华大学 | 一种平面电机运动控制方法、装置及*** |
CN112965509B (zh) * | 2021-02-09 | 2022-10-18 | 内蒙古大学 | 一种两轮自平衡机器人的控制方法及*** |
CN114148493B (zh) * | 2021-12-06 | 2022-09-13 | 林荣云南科技有限公司 | 载人型水下航行器 |
CN116101464B (zh) * | 2022-09-20 | 2024-07-02 | 西北工业大学深圳研究院 | 无人水下航行器含有动态参数的变阶次模糊逻辑控制方法 |
Citations (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH092383A (ja) * | 1995-06-26 | 1997-01-07 | Ishikawajima Harima Heavy Ind Co Ltd | Rovの自動制御方法 |
CN101436074A (zh) * | 2008-12-06 | 2009-05-20 | 中国海洋大学 | 采用同时定位与地图构建方法的自主式水下机器人 |
CN101607589A (zh) * | 2009-07-17 | 2009-12-23 | 哈尔滨工程大学 | 深潜救生艇四自由度动力定位装置及控位方法 |
CN104155991A (zh) * | 2014-08-25 | 2014-11-19 | 南京工程学院 | 水下机器人位姿控制方法 |
CN104326074A (zh) * | 2014-10-27 | 2015-02-04 | 中国船舶重工集团公司第七〇五研究所 | 基于cam矩阵的水下机器人矢量推力分配方法 |
CN105319987A (zh) * | 2015-11-09 | 2016-02-10 | 哈尔滨工程大学 | 一种作业型rov训练模拟器的运动控制仿真*** |
CN106270802A (zh) * | 2016-11-03 | 2017-01-04 | 东北石油大学 | 一种海底管道切割用水下机器人 |
CN106335616A (zh) * | 2016-09-08 | 2017-01-18 | 哈尔滨工程大学 | 一种过驱动遥控作业水下机器人的推力分配方法 |
CN106681352A (zh) * | 2015-11-06 | 2017-05-17 | 中国科学院沈阳自动化研究所 | 一种可旋转舵推进器的水下机器人控制方法 |
CN206520736U (zh) * | 2017-03-07 | 2017-09-26 | 深圳市吉影科技有限公司 | 水下机器人 |
CN206615377U (zh) * | 2017-04-18 | 2017-11-07 | 深圳市吉影科技有限公司 | 一种水下推进器及水下机器人 |
CN107428401A (zh) * | 2014-12-26 | 2017-12-01 | 泰克纳里阿研究与创新基金 | 水下航行器 |
CN107690406A (zh) * | 2017-08-09 | 2018-02-13 | 深圳微孚智能信息科技有限公司 | 具有多个航行自由度的水下机器人 |
CN107953350A (zh) * | 2016-10-17 | 2018-04-24 | 江苏舾普泰克自动化科技有限公司 | 一种用于检测与作业的水下机器人控制*** |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3346006B2 (ja) * | 1993-12-27 | 2002-11-18 | 石川島播磨重工業株式会社 | Rovの自動制御方法 |
US9776715B2 (en) * | 2002-10-01 | 2017-10-03 | Andrew H B Zhou | Amphibious vertical takeoff and landing unmanned device |
US9493235B2 (en) * | 2002-10-01 | 2016-11-15 | Dylan T X Zhou | Amphibious vertical takeoff and landing unmanned device |
US10331131B2 (en) * | 2011-05-12 | 2019-06-25 | Unmanned Innovations, Inc. | Systems and methods for payload integration and control in a multi-mode unmanned vehicle |
US20160376000A1 (en) * | 2014-07-10 | 2016-12-29 | Christoph Kohstall | Submersible unmanned aerial vehicles and associated systems and methods |
CN105404303B (zh) * | 2015-12-28 | 2018-04-10 | 河海大学常州校区 | 一种rov水下机器人的运动控制方法 |
CN105607476A (zh) * | 2016-01-04 | 2016-05-25 | 哈尔滨工程大学 | 一种作业型rov六自由度运动控制方法 |
CN108563234A (zh) * | 2018-05-09 | 2018-09-21 | 深圳市吉影科技有限公司 | 一种水下无人机自平衡控制方法及*** |
-
2018
- 2018-05-09 CN CN201810436252.7A patent/CN108563234A/zh active Pending
- 2018-10-30 WO PCT/CN2018/112597 patent/WO2019214173A1/zh active Application Filing
-
2020
- 2020-11-04 US US17/088,609 patent/US20210047019A1/en active Pending
Patent Citations (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH092383A (ja) * | 1995-06-26 | 1997-01-07 | Ishikawajima Harima Heavy Ind Co Ltd | Rovの自動制御方法 |
CN101436074A (zh) * | 2008-12-06 | 2009-05-20 | 中国海洋大学 | 采用同时定位与地图构建方法的自主式水下机器人 |
CN101607589A (zh) * | 2009-07-17 | 2009-12-23 | 哈尔滨工程大学 | 深潜救生艇四自由度动力定位装置及控位方法 |
CN104155991A (zh) * | 2014-08-25 | 2014-11-19 | 南京工程学院 | 水下机器人位姿控制方法 |
CN104326074A (zh) * | 2014-10-27 | 2015-02-04 | 中国船舶重工集团公司第七〇五研究所 | 基于cam矩阵的水下机器人矢量推力分配方法 |
CN107428401A (zh) * | 2014-12-26 | 2017-12-01 | 泰克纳里阿研究与创新基金 | 水下航行器 |
CN106681352A (zh) * | 2015-11-06 | 2017-05-17 | 中国科学院沈阳自动化研究所 | 一种可旋转舵推进器的水下机器人控制方法 |
CN105319987A (zh) * | 2015-11-09 | 2016-02-10 | 哈尔滨工程大学 | 一种作业型rov训练模拟器的运动控制仿真*** |
CN106335616A (zh) * | 2016-09-08 | 2017-01-18 | 哈尔滨工程大学 | 一种过驱动遥控作业水下机器人的推力分配方法 |
CN107953350A (zh) * | 2016-10-17 | 2018-04-24 | 江苏舾普泰克自动化科技有限公司 | 一种用于检测与作业的水下机器人控制*** |
CN106270802A (zh) * | 2016-11-03 | 2017-01-04 | 东北石油大学 | 一种海底管道切割用水下机器人 |
CN206520736U (zh) * | 2017-03-07 | 2017-09-26 | 深圳市吉影科技有限公司 | 水下机器人 |
CN206615377U (zh) * | 2017-04-18 | 2017-11-07 | 深圳市吉影科技有限公司 | 一种水下推进器及水下机器人 |
CN107690406A (zh) * | 2017-08-09 | 2018-02-13 | 深圳微孚智能信息科技有限公司 | 具有多个航行自由度的水下机器人 |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2019214173A1 (zh) * | 2018-05-09 | 2019-11-14 | 深圳市吉影科技有限公司 | 一种水下无人机自平衡控制方法及*** |
CN110032208A (zh) * | 2019-05-20 | 2019-07-19 | 吉林大学 | 一种用于水下侦查与摄影无人机及其控制方法 |
CN110032208B (zh) * | 2019-05-20 | 2024-01-26 | 吉林大学 | 一种用于水下侦查与摄影无人机及其控制方法 |
CN110262565A (zh) * | 2019-05-28 | 2019-09-20 | 深圳市吉影科技有限公司 | 应用于水下六推无人机的目标跟踪运动控制方法及装置 |
CN111338206A (zh) * | 2020-04-23 | 2020-06-26 | 深圳市吉影科技有限公司 | 一种水下航行器的自动平衡方法及*** |
CN111338206B (zh) * | 2020-04-23 | 2023-07-14 | 深圳市吉影科技有限公司 | 一种水下航行器的自动平衡方法及*** |
CN112033347A (zh) * | 2020-08-31 | 2020-12-04 | 中广核检测技术有限公司 | 一种水下遥控载具及其姿态检测方法 |
CN114030579A (zh) * | 2021-12-07 | 2022-02-11 | 杭州电子科技大学 | 一种无人船稳定控制方法及推进装置 |
CN115571309A (zh) * | 2022-11-25 | 2023-01-06 | 青州鑫聚隆装备制造有限公司 | 一种多功能智联的水下机器人控制方法及其控制*** |
CN115571309B (zh) * | 2022-11-25 | 2023-03-24 | 青州鑫聚隆装备制造有限公司 | 一种多功能智联的水下机器人控制方法及其控制*** |
Also Published As
Publication number | Publication date |
---|---|
WO2019214173A1 (zh) | 2019-11-14 |
US20210047019A1 (en) | 2021-02-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108563234A (zh) | 一种水下无人机自平衡控制方法及*** | |
JP4339016B2 (ja) | 推力配分方法及び推力配分装置 | |
JP2018176922A (ja) | 船舶の運動制御装置および運動制御方法 | |
CN109911110B (zh) | 变稳船 | |
CN109634299A (zh) | 基于多模态控制的飞翼无人机机动飞行控制方法 | |
CN107132761B (zh) | 一种采用纯模糊与模糊pid复合控制的电动舵机设计方法 | |
CN106843245A (zh) | 一种无人机姿态控制方法、装置及无人机 | |
CN108762283B (zh) | 带有旋转载荷的卫星平台的姿态控制方法、装置及*** | |
CN212766696U (zh) | 水下机器人运动控制***及水下机器人 | |
WO2019233019A1 (zh) | 一种三推水下无人机的闭环运动控制方法及其*** | |
CN111459188B (zh) | 一种基于四元数的多旋翼非线性飞行控制方法 | |
CN109085753B (zh) | 基于非线性加权矩阵的磁悬浮控制敏感陀螺群伪逆操纵律 | |
CN104950905A (zh) | 一种基于复合pid的质心调节机构及调节方法 | |
CN111846166A (zh) | 水下机器人运动控制***及水下机器人 | |
CN108459605A (zh) | 基于agv***的轨迹跟踪控制方法 | |
CN108693772A (zh) | 搬运机器人伺服驱动***的增益调节方法、装置及机器人 | |
CN109976364B (zh) | 一种六旋翼飞行器姿态解耦控制方法 | |
CN111338369A (zh) | 一种基于非线性逆补偿的多旋翼飞行控制方法 | |
CN117227967B (zh) | 用于控制飞行器的方法、装置、介质和飞行器 | |
CN110032208A (zh) | 一种用于水下侦查与摄影无人机及其控制方法 | |
CN115185186A (zh) | 一种基于多电机协同的水下推进器控制方法 | |
JP6867634B1 (ja) | 姿勢制御装置及び姿勢制御方法 | |
CN106919185A (zh) | 基于Dubins曲线的稳定平台位置伺服控制方法 | |
JP2749833B2 (ja) | 制御推力配分装置 | |
JPWO2021024591A5 (zh) |
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 | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20180921 |