本发明涉及水下机器人控制技术领域,具体为一种基于一致性算法的水下清洗机器人调头侧移量控制方法。
背景技术:
相对于公路运输和航空运输,船舶运输具有营运成本低、运载量大等特点,已成为当前国内、国际间大宗货物运输的重要手段。由于常年水中航行,船舶外壳容易附着厚重坚硬的垢层。这类船舶附着物不仅会加速船体的腐蚀,缩短船舶使用寿命,而且还会使船体表面更加粗造,使航行阻力增大,进而抬高运营成本。因此,为了延长船舶使用寿命,降低船舶运营成本,需要定期清除船舶表面的附着物。
当前,多采用人工潜水方式对船舶表面进行清除,即手持锤子、铲子或喷枪等设备对附着物进行清除。这类清洗方式存在劳动强度大、危险性高、清洗效率低等问题。因此,研制水下清洗机器人来提高船舶表面附着物清除效率具有重要意义。
受限于清洗设备的尺寸,水下清洗机器人的清洗宽度通常是有限的。因此,需要合理设计水下清洗机器人的覆盖控制算法,以实现对船体表面附着物的无重复无遗漏地高效率清洗。沿着预定规划路径循环式覆盖方法作为一种实用简单的覆盖控制算法广泛应用于实际工程中,其核心在于机器人调头侧移量的精确控制。基于此,面向左右履带驱动的水下清洗机器人调头侧移量的控制是一个很有理论和实际意义的研究问题。
但是,目前针对水下清洗机器人研究都是针对理想情况的分析,而在实际工程应用中,我们发现对于左右履带驱动的水下清洗机器人,由于左右履带负载的不一致性,以及左右履带的驱动电机特性的不一致性,均会导致调头侧移量存在控制误差。因此,如何设计合适的调头控制方法以抵抗上述实际干扰因素,是一个迫切需要研究的问题。
技术实现要素:
要解决的技术问题
在面向无重复无遗漏地清洗船体表面需求下,采用左右履带驱动的水下清洗机器人调头侧移量的控制还存在以下两个问题:
1、如何构造左右履带速度与调头侧移量之间关系;
2、左右履带负载和电机驱动特性的不一致性导致的左右履带速度响应不一致;
针对上述问题,本发明提出一种基于一致性算法的水下清洗机器人调头侧移量控制方法,能有效地抵抗左右履带负载和电机驱动特性不一致造成的干扰,保证控制系统有良好的性能。
技术方案
所述一种基于一致性算法的水下清洗机器人调头侧移量控制方法,其特征在于:包括以下步骤:
步骤1:忽略水下清洗机器人在贴壁后履带行走时的打滑,建立水下清洗机器人的运动学方程:
其中,(x,y)和ψ分别为清洗机器人的位置和航向角,
步骤2:当左右履带转速分别为
当
步骤3:为了使调头侧移量为yc,需保证水下清洗机器人按期望侧移方向,以偏离机器人中心
此时水下清洗机器人左右履带相对旋转原点的角速度大小应当保持一致,方向应当相反,满足以下关系式:
步骤4:利用一致性算法,来设计调头侧移量控制律:
进行水下清洗机器人调头控制,其中v1和v2为期望的履带速度;yc为水下清洗机器人期望的调头侧移量;k1和k2均为大于零的常数。
有益效果
本发明在构造调头侧移量与左右履带速度之间关系的基础上,利用一致性收敛原理设计水下了清洗机器人调头侧移量闭环控制方法,其通过在线调节期望履带速度,来主动适应由于左右履带负载和驱动特性的差异性造成的不确定干扰,以达到准确控制水下清洗机器人调头侧移量的目的。
本发明的附加方面和优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本发明的实践了解到。
附图说明
本发明的上述和/或附加的方面和优点从结合下面附图对实施例的描述中将变得明显和容易理解,其中:
附图1为水下清洗机器人调头侧移量控制系统示意图。
附图2为水下清洗机器人旋转原点生成机制示意图。
附图3为水下清洗机器人调头运动轨迹图。
附图4为水下清洗机器人左右履带速度变化曲线图。
附图5为水下清洗机器人调头侧移量变化曲线图。
具体实施方式
下面结合具体实施来描述本发明:
本实施例以某型由多推进器混合驱动贴壁+双履带行走的水下清洗机器人为研究对象。水下清洗机器人的左右履带间距为l=1m;水下清洗机器人期望的调头下移量设置为yc=0.2m,且定义初始位置和初始航向角均为零,即x(0)=y(0)=ψ(0)=0;定义左右履带初始速度分别为
步骤1:由于多推进器混合驱动实现贴壁,因此可以忽略水下清洗机器人在贴壁后履带行走时的打滑,建立水下清洗机器人的运动学方程:
其中,(x,y)和ψ分别为清洗机器人的位置和航向角,
步骤2:如图2所示,当左右履带转速分别为
当
步骤3:为了使调头侧移量为yc,则需保证水下清洗机器人按期望侧移方向,以偏离机器人中心
因此,水下清洗机器人左右履带相对旋转原点的角速度大小应当保持一致,方向应当相反,即满足以下关系式:
在实际工程中,水下清洗机器人左右履带负载的不一致性,以及左右履带的驱动电机特性的不一致性,均会导致调头侧移量存在控制误差。为了削弱上述干扰因素的不利影响,需要设计合理的自适应调节机制,以确保水下清洗机器人的当前旋转中心能收敛于期望的旋转中心,即保证
步骤4:利用一致性算法,来设计调头侧移量控制律:
其中,
针对本实施例中的水下清洗机器人运动模型,采用上述的控制方法进行调头控制。为了验证所提方法的优越性,本发明与传统开环控制律
以上所述,仅是本发明的较佳实施例而已,并非对本发明作任何形式上的限制,虽然本发明已以较佳实施例揭露如上,然而并非用以限定本发明,任何熟悉本专业的技术人员,在不脱离本发明技术方案范围内,当可利用上述揭示的技术内容作出些许更动或修饰为等同变化的等效实施例,但凡是未脱离本发明技术方案的内容,依据本发明的技术实质对以上实施例所作任何的简单修改、等同变化与修饰,均仍属于本发明技术方案的范围内。