CN106708069B - 水下移动作业机器人的协调规划与控制方法 - Google Patents
水下移动作业机器人的协调规划与控制方法 Download PDFInfo
- Publication number
- CN106708069B CN106708069B CN201710039881.1A CN201710039881A CN106708069B CN 106708069 B CN106708069 B CN 106708069B CN 201710039881 A CN201710039881 A CN 201710039881A CN 106708069 B CN106708069 B CN 106708069B
- Authority
- CN
- China
- Prior art keywords
- speed
- state
- task
- planning
- acceleration
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 53
- 238000013439 planning Methods 0.000 title claims abstract description 41
- 230000033001 locomotion Effects 0.000 title claims abstract description 14
- 230000001133 acceleration Effects 0.000 claims abstract description 31
- 239000011159 matrix material Substances 0.000 claims description 8
- 238000005516 engineering process Methods 0.000 claims description 4
- 238000010586 diagram Methods 0.000 description 4
- 241000282414 Homo sapiens Species 0.000 description 3
- 239000011664 nicotinic acid Substances 0.000 description 3
- 238000013461 design Methods 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 238000013507 mapping Methods 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 238000005065 mining Methods 0.000 description 2
- 238000012913 prioritisation Methods 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 238000006467 substitution reaction Methods 0.000 description 2
- 229910000831 Steel Inorganic materials 0.000 description 1
- 230000009471 action Effects 0.000 description 1
- 230000003044 adaptive effect Effects 0.000 description 1
- 238000009360 aquaculture Methods 0.000 description 1
- 244000144974 aquaculture Species 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 230000001808 coupling effect Effects 0.000 description 1
- 230000004069 differentiation Effects 0.000 description 1
- 230000009189 diving Effects 0.000 description 1
- 210000002310 elbow joint Anatomy 0.000 description 1
- 238000003912 environmental pollution Methods 0.000 description 1
- 238000007667 floating Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 210000000323 shoulder joint Anatomy 0.000 description 1
- 239000010959 steel Substances 0.000 description 1
- 210000003857 wrist joint Anatomy 0.000 description 1
Images
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/04—Control of altitude or depth
- G05D1/06—Rate of change of altitude or depth
- G05D1/0692—Rate of change of altitude or depth specially adapted for under-water vehicles
-
- 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
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开一种水下移动作业机器人的协调规划与控制方法。该方法包括:通过动态追踪微分器,实时规划当前期望的速度与状态;用迭代任务优先方法,将笛卡尔空间的任务规划转化到随体坐标系和各关节坐标系的速度与加速度规划;根据速度与加速度规划,利用动力学方法来控制潜器和作业臂,从而使得水下移动作业机器人进行巡游与作业。本发明实例采用动态追踪微分器,实施规划当前各任务的期望速度与期望状态,然后,采用状态观测器,估计当前任务状态与速度,并反馈至控制输入,最后通过鲁棒的迭代任务优先方法实现闭环控制,提高了水下移动作业机器人的自主化水平,最终解决了如何实现水下移动作业机器人全自主巡游与作业的技术问题。
Description
技术领域
本发明涉及机器人技术领域,尤其是涉及一种水下移动作业机器人的协调规划与控制方法。
背景技术
广阔的海洋为人类提供了丰富的资源,对海洋资源的高效利用和可持续开发对人类具有重要的意义。人类对海洋的探索从未停止,从最原始的载人水下航行器,到遥控型水下航行器,再到如今的全自主无人水下航行器的研究,这些极大地推动了人类对海洋的认识和开发。特别是在海产养殖中,我国近浅海水产养殖业迅猛发展,各类水产品产量巨大,由于捕捞技术落后,却面临着效率低、浅海环境污染、植被破坏及资源消耗严重的窘境。利用潜水员在水下作业采捕海珍品的人工采捕方式对环境无破坏,但这种方式的效率低,作业时间有限,作业环境恶劣,而且潜在危险多等。随着对海洋环境保护和工作效率要求的不断提高,采用水下移动作业机器人等采捕设备替代人工水下作业的需求愈发迫切。水下移动作业机器人一般由移动平台和一个或多个机械臂组成,移动平台和机械臂按需求设计、制造后组装集成在一起,通过高度集成的感知、规划与控制***,实现机器人的水下自主作业。在非结构化未知的水下环境,水下移动作业机器人实现全自主作业主要分为自主巡游与自主作业两个阶段。欧美及其日本研制各类型的水下机器人作业***,这些作业机器人普遍通过遥控或者半自主的方式进行水下作业,普遍存在自主化水平不足、操作技术要求高等弊端。
有鉴于此,特提出本发明。
发明内容
为了解决现有技术中的上述问题,即为了解决如何实现水下移动作业机器人全自主巡游与作业的技术问题,提供一种水下移动作业机器人的协调规划与控制方法。
为了实现上述目的,提供以下技术方案:
一种水下移动作业机器人的协调规划与控制方法,该方法包括:
通过动态追踪微分器,实时规划当前期望的速度与状态;
采用迭代任务优先方法,将笛卡尔空间的任务规划转化到随体坐标系和各关节坐标系的速度与加速度规划;
根据速度与加速度规划,利用动力学方法来控制潜器和作业臂,从而使得水下移动作业机器人进行巡游与作业。
优选地,通过动态追踪微分器,实时规划当前期望的速度与状态具体包括:
利用自抗扰技术,通过动态追踪微分器将阶跃型任务信号转化为连续的光滑信号,并得到当前期望的速度和状态。
优选地,根据下式来建立动态追踪微分器:
f=f(v1-v0,v2,r0,h0)
v1=v1+h0v2
v2=v2+h0f
其中,v0表示给定的期望目标点;v1表示状态规划;v2表示速度规划;r0、h0分别表示影响微分器曲线的速度和光滑程度的微分器参数;
其中,f根据下式确定:
优选地,采用迭代任务优先方法,将笛卡尔空间的任务规划转化到随体坐标系和各关节坐标系的速度与加速度规划,具体包括:
通过迭代任务优先方法进行冗余迭代,对笛卡尔空间世界坐标系下任务规划进行转化,求解在随体坐标和各关节坐标系下的期望速度与期望加速度。
优选地,方法还包括:
通过状态观测器观测估计当前的任务速度与任务状态,并进行实时反馈,以更新速度与加速度规划。
优选地,实时反馈中的反馈信号通过以下方式来确定:
根据当前规划的期望速度和期望加速度、当前速度误差和当前状态误差,并且与规划的速度加权结合,来确定反馈信号。
优选地,状态观测器通过下式来建立:
e=z1-z0
z1=z1+h0(z2-β01e)
z2=z2+h0(z3-β02e+Jζ)
z3=z3+h0(-β03e)
其中,β01、β02、β03表示设定的保证收敛的参数;z0表示期望的目标状态;z1、z2、z3分别表示对状态、速度和加速度的观测估计;J表示相对应的雅克比矩阵;ζ由任务速度规划与误差(状态误差与速度误差)共同组成的反馈项;h0表示影响微分器曲线的光滑程度的微分器参数。
本发明实施例提供一种水下移动作业机器人的协调规划与控制方法。该方法包括:通过动态追踪微分器,实时规划当前期望的速度与状态;用迭代任务优先方法,将笛卡尔空间的任务规划转化到随体坐标系和各关节坐标系的速度与加速度规划;根据速度与加速度规划,利用动力学方法来控制潜器和作业臂,从而使得水下移动作业机器人进行巡游与作业。本发明实施例将自主巡游和自主作业过程的各个子任务统一起来,采用动态追踪微分器,实施规划当前各任务的期望速度与期望状态,然后,采用状态观测器,估计当前任务状态与速度,并反馈至控制输入,最后通过鲁棒的迭代任务优先方法实现闭环控制,提高了水下移动作业机器人的自主化水平,最终实现了水下移动作业机器人全自主巡游与作业。
附图说明
图1为根据本发明实施例的水下移动机器人作业臂***的示意图;
图2为根据本发明实施例的水下移动作业机器人坐标系示意图;
图3为根据本发明实施例的水下移动作业机器人的协调规划与控制方法的流程示意图;
图4为根据本发明实施例的带有跟踪微分器和状态观测器的鲁棒迭代任务优先算法的流程示意图。
具体实施方式
下面参照附图来描述本发明的优选实施方式。本领域技术人员应当理解的是,这些实施方式仅仅用于解释本发明的技术原理,并非旨在限制本发明的保护范围。
本发明实施例基本构思是将航行器舰体和机械臂做统一的规划和控制,充分考虑艇体与机械臂的耦合作用,将自主作业的任务划分为若干个子任务,并将子任务做优先级排列,然后,按照优先级顺序依次融合各子任务控制策略与方案,从而完成各子任务并实现最终的作业任务。
图1是水下移动机器人作业臂***,该***主要由两侧对称装配的仿生推动器、作业臂和艇体三部分组成。对称的仿生推进器可以提供机器人前进、后退、侧移、上浮、下潜、正逆旋转所需要的力和力矩,即在本体坐标系中具有四个自由度,如图2所示,分别沿Ob-x,y,z方向的平移运动以及绕Ob-z的旋转运动。在机械臂上,也存在四个自由度,分别是腰关节、肩关节、肘关节、腕关节,分别可以做左右摆动上下摆动、上下摆动和旋转运动,机械臂末端为双指夹器,通过钢丝牵动实现目标的夹取等,各关节分别建立Oi-x,y,z,i=0,1,2,3坐标系。
借助于机械臂运动学模型,给定任务与***速度的关系可以表示为:
在横滚和俯仰角的控制上,仅仅通过长鳍波动实现,相当困难。除此之外,当自主作业时,如果带有俯仰和横滚角,自主作业的控制和实现也比较困难,因此在实际规划和作业过程中,需要限制水下移动作业机器人的俯仰角和横滚角始终为零。
为此本发明实施例提供一种水下移动作业机器人的协调规划与控制方法。如图3所示该方法可以包括:
S1:通过动态追踪微分器,实时规划当前期望的速度与状态。
具体地,本步骤可以包括:利用自抗扰技术,通过动态追踪微分器将阶跃型任务信号转化为连续的光滑信号并得到当前期望的速度和状态。
在实际应用中,控制目标往往是一种阶跃信号形式,例如,到达指定的位置等,因此,输出信号存在跳跃,严格的追踪阶跃轨迹非常困难,另外,***反馈信号并不精确,因此基于自适应抗扰动技术,来根据当前的状态与期望目标,规划当前的速度、状态等信息。
在一个优选的实施例中,可以根据下式来建立动态追踪微分器:
f=f(v1-v0,v2,r0,h0)
v1=v1+h0v2
v2=v2+h0f
其中,v0表示给定的期望目标点;v1表示状态规划;v2表示速度规划或任务速度规划;r0、h0分别表示影响微分器曲线的速度和光滑程度的微分器参数;其中,f(·)根据下式确定:
a0=h0v2
y=v1+a0
a2=a0+sign(y)(a1-d)/2
sy=(sign(y+d)-sign(y-d))/2
a=(a0+y-a2)sy+a2
sa=(sign(a+d)-sign(a-d))/2
f=-r0(a/d-sign(a))sa-r0sign(a)
本发明实施例通过采用动态追踪微分器,将阶跃型任务信号转化为连续的光滑信号,使得控制信号连续光滑,实现了信号的连续性和可微性,使得控制信号更加细致化,避免了信号的阶跃型跳跃和震动;而且动态追踪微分器将信号平滑化的同时,给出了当前的速度规划,并且实时计算出当前的速度和状态信息。
图4示例性地示出了得到任务的状态与速度规划的示意图。沿用前例,以3个任务(i=1,2,3)进行示例性说明。其中,对任务集σz并结合机器人的位姿η和机械臂各关节角q进行运动学控制,得到***参考速度vd与***参考加速度然后根据vd、进行动力学控制,得到期望的力和力矩τd;然后,期望的力和力矩τd输入至驱动控制部分;驱动控制部分输出机器人艇体的速度v与加速度速度v与加速度再反馈至动力学控制部分;σ1、σ2、σ3是给定任务中三个子任务,通过追踪微分器(TD1、TD2、TD3)之后,可以得到各个子任务的状态与速度规划。其中,i=1,2,3;σi为给定的第i个任务,TDi为追踪微分器(TrackingDifferentiator),σid,为第i个任务的状态规划和速度规划;Kip,Kid为状态误差和速度误差的加权系数;ζi是满足第i个任务所需要的***速度;Qi-1是零空间映射算子;ζ为满足所有任务的***速度;dζ/dt对速度进行时间微分,得到加速度信息;v,为机器人艇体的速度与加速度;为机械臂各关节的旋转速度和加速度,q为机械臂各关节角;η是机器人的位姿;SOi为状态观测器(State Observer);为第i个任务的状态和速度的观测。
S2:采用迭代任务优先方法,将笛卡尔空间的任务规划转化到随体坐标系和各关节坐标系的速度与加速度规划。
其中,迭代任务优先方法具有很好的鲁棒性。目标任务可以是在笛卡尔空间世界坐标系中给定的。
作为另一个实施例,具体地,本步骤可以包括:通过迭代任务优先方法进行冗余迭代,对笛卡尔空间世界坐标系下任务规划进行转化,求解在随体坐标和各关节坐标系下的期望速度与期望加速度。
本步骤采用任务优先方法框架,将笛卡尔空间世界坐标系下任务规划转化到随体坐标系和各关节坐标系的速度与加速度规划,并作为动力学控制的信息输入。
沿用图4所示示例,σ1处于最高优先级,σ2次之,σ3优先级最低,根据下式通过任务优先方法进行依次迭代:
ζ=v2+k1(v1-z1)+k2(v2-z2)
其中,ζ表示由任务速度规划v2与误差(状态误差与速度误差)共同组成的反馈项;Q表示零空间映射算子;k1表示状态误差加权系数;k2表示速度误差加权系数;z1表示对状态的观测估计;z2表示对速度的观测估计;I表示单位矩阵;i表示当前任务索引,即表示将所有给定任务依次进行迭代,其最大值是给定的任务总数;表示第i个任务的相应雅克比矩阵的广义逆矩阵;Ji表示第i个任务的相应雅克比矩阵;ρi表示迭代输出结果。
图4示例性地示出了带有跟踪微分器和状态观测器的鲁棒迭代任务优先算法的流程示意图。通过图4所示方法,消除了经典任务优先算法的运动学奇异和算法奇异现象,保证了控制算法的鲁棒性,本发明实施例可以将所有的任务依次迭代,计算出满足所有任务需求的在随体坐标系和各关节坐标系中的速度与加速度。
S3:根据速度与加速度规划,利用动力学方法来控制潜器和作业臂,从而产生水下移动作业机器人的巡游与作业。
在一个优选的实施例中,本发明实施例提供的方法还可以包括:通过状态观测器观测估计当前的任务速度与任务状态,并进行实时反馈,以更新速度与加速度规划。
其中,通过状态观测器观测估计当前的速度与状态,并实时反馈至输入端,构成闭环控制,从而可以提高本发明实施例的稳定性。
在一个优选的实施例中,实时反馈中的反馈信号通过以下方式来确定:根据当前规划的期望速度和期望加速度、当前速度误差和当前状态误差,并且与规划的速度加权结合,来确定反馈信号。
在一个优选的实施例中,状态观测器通过下式来建立:
e=z1-z0
z1=z1+h0(z2-β01e)
z2=z2+h0(z3-β02e+Jζ)
z3=z3+h0(-β03e)
其中,β01、β02、β03表示设定的保证收敛的参数;z1、z2、z3分别表示对状态、速度和加速度的观测估计;z0表示期望的目标状态;J表示相对应的雅克比矩阵;ζ由任务速度规划与误差(状态误差与速度误差)共同组成的反馈项;h0表示影响微分器曲线的光滑程度的微分器参数。
本发明实施例通过采用上述技术方案,实现了潜器-作业臂协调规划与运动控制的闭环控制,解决了如何实现水下移动作业机器人的自主巡游与作业的技术问题。通过状态观测器可以实时地观测估计***的状态和速度信息,从而大大提高了在末端自主作业时的稳定性和精准度;而且,反馈信号综合考虑了当前规划的期望速度、当前速度误差及当前状态误差,相比于单一的状态误差方法而言,其收敛速度更快;将自主巡游和自主作业两个阶段的不同任务做统一考虑,无需进行阶段划分和状态切换机制的设计,可以同时考虑多个任务的同时执行而且消除任务之间的相互影响,从而保证迭代更多的任务,将所有的任务都统一在本框架之下,通过自适应调节机制,能够保证在不同阶段对不同的性能指标的要求,可以统一实现自主的高速高机动自主巡游和高稳定高精准自主作业,例如:在巡游阶段的高速高机动性,作业阶段的高稳定高精度性,消除了经典任务优先方法的运动学奇异和方法奇异,保证了方法的鲁棒性。
至此,已经结合附图所示的优选实施方式描述了本发明的技术方案,但是,本领域技术人员容易理解的是,本发明的保护范围显然不局限于这些具体实施方式。在不偏离本发明的原理的前提下,本领域技术人员可以对相关技术特征作出等同的更改或替换,这些更改或替换之后的技术方案都将落入本发明的保护范围之内。
Claims (6)
1.一种水下移动作业机器人的协调规划与控制方法,其特征在于,所述方法包括:
通过动态追踪微分器,实时规划当前期望的速度与状态;
采用迭代任务优先方法,将笛卡尔空间的任务规划转化到随体坐标系和各关节坐标系的速度与加速度规划;
根据所述速度与所述加速度规划,利用动力学方法来控制潜器和作业臂,从而使得所述水下移动作业机器人进行巡游与作业;
其中,根据下式来建立所述动态追踪微分器:
f=f(v1-v0,v2,r0,h0)
v1=v1+h0v2
v2=v2+h0f
其中,所述v0表示给定的期望目标点;所述v1表示状态规划;所述v2表示速度规划;所述r0、h0分别表示影响微分器曲线的速度和光滑程度的微分器参数;
其中,所述f根据下式确定:
2.根据权利要求1所述的方法,其特征在于,所述通过动态追踪微分器,实时规划当前期望的速度与状态具体包括:
利用自抗扰技术,通过所述动态追踪微分器将阶跃型任务信号转化为连续的光滑信号,并得到当前期望的速度和状态。
3.根据权利要求1所述的方法,其特征在于,所述采用迭代任务优先方法,将笛卡尔空间的任务规划转化到随体坐标系和各关节坐标系的速度与加速度规划,具体包括:
通过所述迭代任务优先方法进行冗余迭代,对笛卡尔空间世界坐标系下任务规划进行转化,求解在随体坐标和各关节坐标系下的期望速度与期望加速度。
4.根据权利要求1所述的方法,其特征在于,所述方法还包括:
通过状态观测器观测估计当前的任务速度与任务状态,并进行实时反馈,以更新所述速度与所述加速度规划。
5.根据权利要求4所述的方法,其特征在于,所述实时反馈中的反馈信号通过以下方式来确定:
根据当前规划的期望速度和期望加速度、当前速度误差和当前状态误差,并且与规划的速度加权结合,来确定所述反馈信号。
6.根据权利要求4所述的方法,其特征在于,所述状态观测器通过下式来建立:
e=z1-z0
z1=z1+h0(z2-β01e)
z2=z2+h0(z3-β02e+Jζ)
z3=z3+h0(-β03e)
其中,所述β01、β02、β03表示设定的保证收敛的参数;所述z0表示期望的目标状态;所述z1、z2、z3分别表示对状态、速度和加速度的观测估计;所述J表示相对应的雅克比矩阵;所述ζ由任务速度规划、状态误差与速度误差共同组成的反馈项;所述h0表示影响微分器曲线的光滑程度的微分器参数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710039881.1A CN106708069B (zh) | 2017-01-19 | 2017-01-19 | 水下移动作业机器人的协调规划与控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710039881.1A CN106708069B (zh) | 2017-01-19 | 2017-01-19 | 水下移动作业机器人的协调规划与控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106708069A CN106708069A (zh) | 2017-05-24 |
CN106708069B true CN106708069B (zh) | 2020-01-10 |
Family
ID=58908546
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710039881.1A Active CN106708069B (zh) | 2017-01-19 | 2017-01-19 | 水下移动作业机器人的协调规划与控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106708069B (zh) |
Families Citing this family (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2019127945A1 (zh) * | 2017-12-26 | 2019-07-04 | 佛山科学技术学院 | 基于结构化神经网络的成像任务可调度性预测方法 |
CN108646758B (zh) * | 2018-03-20 | 2019-11-01 | 南京邮电大学 | 一种多移动机器人预设性能编队控制器结构及设计方法 |
CN108820167A (zh) * | 2018-05-25 | 2018-11-16 | 哈尔滨工程大学 | 一种仿生型水下机器人的操纵***及区域控位控制方法 |
CN109739249B (zh) * | 2018-09-06 | 2022-04-19 | 中国船舶工业***工程研究院 | 一种速度状态缺失条件下的多uuv编队协调控制方法 |
CN109144075A (zh) * | 2018-10-29 | 2019-01-04 | 长沙理工大学 | 一种无人船的控制***和控制方法 |
CN110032198A (zh) * | 2019-04-30 | 2019-07-19 | 苏州蓝智特种机器人有限公司 | 一种水下特种机器人艇-手多体动力学建模方法及装置 |
CN111687833B (zh) * | 2020-04-30 | 2023-06-02 | 广西科技大学 | 机械手逆优先级阻抗控制***及控制方法 |
CN111687832B (zh) * | 2020-04-30 | 2023-06-02 | 广西科技大学 | 空间机械手冗余机械臂逆优先级阻抗控制***及控制方法 |
CN111687835B (zh) * | 2020-04-30 | 2023-06-02 | 广西科技大学 | 水下机械手冗余机械臂逆优先级阻抗控制***及控制方法 |
CN111687834B (zh) * | 2020-04-30 | 2023-06-02 | 广西科技大学 | 移动机械手冗余机械臂逆优先级阻抗控制***及控制方法 |
CN111857165B (zh) * | 2020-07-28 | 2021-07-27 | 浙江大学 | 一种水下航行器的轨迹跟踪控制方法 |
CN113084817B (zh) * | 2021-04-15 | 2022-08-19 | 中国科学院自动化研究所 | 扰流环境下水下机器人的物体搜索及抓取控制方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103412567A (zh) * | 2013-04-15 | 2013-11-27 | 上海大学 | 基于线性自抗扰技术的水下机器人深度控制装置和方法 |
CN104898688A (zh) * | 2015-03-27 | 2015-09-09 | 哈尔滨工程大学 | Uuv四自由度动力定位自适应抗扰滑模控制***及控制方法 |
CN104991444A (zh) * | 2015-07-30 | 2015-10-21 | 湖南工业大学 | 基于跟踪微分器的非线性pid自适应控制方法 |
US9268315B2 (en) * | 2002-04-18 | 2016-02-23 | Cleveland State University | Extended active disturbance rejection controller |
CN105717936A (zh) * | 2014-11-30 | 2016-06-29 | 中国科学院沈阳自动化研究所 | 一种无缆自治水下机器人的潜浮控制方法 |
CN105772917A (zh) * | 2014-12-16 | 2016-07-20 | 苏州继企机电科技有限公司 | 一种三关节点焊机器人轨迹跟踪控制方法 |
CN105843233A (zh) * | 2016-04-11 | 2016-08-10 | 哈尔滨工程大学 | 一种基于非线性观测器的自主水下航行器运动控制方法 |
-
2017
- 2017-01-19 CN CN201710039881.1A patent/CN106708069B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9268315B2 (en) * | 2002-04-18 | 2016-02-23 | Cleveland State University | Extended active disturbance rejection controller |
CN103412567A (zh) * | 2013-04-15 | 2013-11-27 | 上海大学 | 基于线性自抗扰技术的水下机器人深度控制装置和方法 |
CN105717936A (zh) * | 2014-11-30 | 2016-06-29 | 中国科学院沈阳自动化研究所 | 一种无缆自治水下机器人的潜浮控制方法 |
CN105772917A (zh) * | 2014-12-16 | 2016-07-20 | 苏州继企机电科技有限公司 | 一种三关节点焊机器人轨迹跟踪控制方法 |
CN104898688A (zh) * | 2015-03-27 | 2015-09-09 | 哈尔滨工程大学 | Uuv四自由度动力定位自适应抗扰滑模控制***及控制方法 |
CN104991444A (zh) * | 2015-07-30 | 2015-10-21 | 湖南工业大学 | 基于跟踪微分器的非线性pid自适应控制方法 |
CN105843233A (zh) * | 2016-04-11 | 2016-08-10 | 哈尔滨工程大学 | 一种基于非线性观测器的自主水下航行器运动控制方法 |
Non-Patent Citations (8)
Title |
---|
Tuning of Auto-Disturbance Rejection Controller Based on the Invasive Weed Optimization;Zhihua Chen etc;《2011 Sixth International Conference on Bio-Inspired Computing: Theories and Applications》;20111231;第314-318页 * |
UUV Trajective Tracking Control Based on ADRC;Guocheng zhang, Chengrong Du, Yushan Sun, Hao Xu and Hongde Qin,;《Proceedings of the 2016 IEEE International Conference on Robotics and Biomimetics》;20161231;第1413-1417页 * |
仿生机器鱼研究的进展与分析;魏清平等;《***科学与数学》;20121231;第1274-1286页 * |
基于ADRC的仿生长鳍机器鱼航向控制方法;魏清平等;《华中科技大学学报(自然科学版)》;20131031;第335-338页 * |
基于小生境粒子群优化的挖掘机器人自抗扰视觉伺服控制;王福斌等;《机械工程学报》;20120131;第32-38页 * |
用跟踪微分器实现机器人自抗扰控制;李殿起等;《兵工学报》;20160930;第1721-1729页 * |
自抗扰控制方法在水面船舶动力定位控制中的应用;吉庆昌等;《舰船科学技术》;20160731;第10-12页 * |
自适应跟踪微分器的研究;景奉水等;《第二十一届中国控制会议论文集》;20020801;第319-322页 * |
Also Published As
Publication number | Publication date |
---|---|
CN106708069A (zh) | 2017-05-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106708069B (zh) | 水下移动作业机器人的协调规划与控制方法 | |
Mohan et al. | Indirect adaptive control of an autonomous underwater vehicle-manipulator system for underwater manipulation tasks | |
CN112068576B (zh) | 一种基于任务分级时序优化的水下无人艇-双机械臂协同控制方法 | |
CN108594846A (zh) | 一种障碍环境下多auv编队队形优化控制方法 | |
Cao et al. | Toward optimal rendezvous of multiple underwater gliders: 3D path planning with combined sawtooth and spiral motion | |
CN108829113B (zh) | 一种多机器人编队自适应零空间行为融合方法 | |
CN110609556A (zh) | 一种基于los导航法的多无人艇协同控制方法 | |
CN112965371B (zh) | 基于固定时间观测器的水面无人艇轨迹快速跟踪控制方法 | |
CN111308890B (zh) | 一种带有指定性能的无人船数据驱动强化学习控制方法 | |
CN111880567A (zh) | 基于深度强化学习的固定翼无人机编队协调控制方法及装置 | |
CN113433955A (zh) | 有向切换拓扑下多auv编队队形一致性控制方法 | |
CN111923049B (zh) | 基于球面模型的飞行机械臂视觉伺服与多任务控制方法 | |
CN114779645B (zh) | 一种有向固定通信拓扑下胸鳍拍动式机器鱼编队控制方法 | |
Sverdrup-Thygeson et al. | A control framework for biologically inspired underwater swimming manipulators equipped with thrusters | |
CN112327892B (zh) | 一种auv误差受限的抗扰控制方法 | |
CN112068440A (zh) | 基于模型预测控制的auv回收对接动力定位控制方法 | |
CN108829126A (zh) | 一种考虑通讯延时的auv集群协调控制方法 | |
Filaretov et al. | Development of control systems for implementation of manipulative operations in hovering mode of underwater vehicle | |
David et al. | Unmanned underwater vehicle navigation and collision avoidance using fuzzy logic | |
Mohan et al. | A null space control of an underactuated underwater vehicle-manipulator system under ocean currents | |
CN212635747U (zh) | 基于球面模型的飞行机械臂视觉伺服结构 | |
CN110703792B (zh) | 基于增强学习的水下机器人姿态控制方法 | |
An et al. | Underwater motion control of a bio-inspired father-son robot based on hydrodynamics analysis | |
Santhakumar | Task space trajectory tracking control of an underwater vehicle-manipulator system under ocean currents | |
Emrani et al. | An adaptive leader-follower formation controller for multiple AUVs in spatial motions |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |