【技术实现步骤摘要】
本专利技术属于轨迹跟踪，具体涉及一种水下机器人机械臂的预定义时间轨迹跟踪控制方法。
技术介绍
1、海洋是一座蕴藏着丰富海洋资源的宝库。近年来，随着海底探测技术的不断发展，自主潜水器(auv)和遥控潜水器(rov)被广泛应用于海洋探测、海底分析和深海勘探等高风险作业中。然而，rov由于其机动性受到与连接的电缆的限制，并且操纵rov必须由训练有素的人类操作员完成。此外，在水下工作时，由于工作环境的复杂性，工作过程是不可预测的，很容易出现位置误差。目前，仅靠水下自动潜航器很难满足水下导航的需求。针对这一问题，国内外学者提出了一种新型水下机器人-机械臂系统(uvms)。在海洋作业中，配备一个或多个机械臂的水下机器人的使用频率远远高于水下机器人或单独的水下机械臂。机械臂的加入赋予了水下机器人更大的机动性和灵活性，使其能够在各种水下作业中发挥更好的性能，因此现在越来越多的人展开了对水下机器人-机械臂系统的研究。
2、在复杂的工作环境中，确保其高效稳定的控制方法，是一个值得深入研究的课题。现有的控制方法主要有pid控制、smc控制和自适应控制等，其中pid控制方法对系统的建模不要求，在大多数时候都有良好的控制效果，但是传统的pid控制方法存在着抗干扰性差、控制速率慢和参数调整繁琐等缺点。smc控制器虽然有很好的鲁棒性，但是会出现抖振，而且还可能存在过冲和振荡等问题。自适应控制由于其良好的自适应性能和鲁棒性能，已成为一种高级控制手段，但其参数需根据实际工况进行动态调节，有时会造成系统的不稳定，为了保证稳定，必须对控制器的参数进行合理
3、目前在轨迹跟踪控制邻域，通常采用各种障碍函数和性能函数，并将其与反步法结合，设计渐近收敛、有限时间收敛和固定时间收敛的控制器，用来限制系统的误差，提高控制精度。但是这些收敛的控制器收敛速度相对较慢慢，并且收敛时间难以估计。此时，预定义时间收敛的控制器开始被大家熟知，它能很好地克服上述的一些问题。
4、尽管目前对水下机器人-机械臂系统的控制研究已有很多，但对于全状态约束的水下机器人-机械臂系统尚未获得相应的研究结果。在实际应用中，由于各种因素的限制，如位置约束和速度约束等；虽然有相关研究涉及到全状态约束下机器人的控制问题，但是并没有相关研究设计到全状态下的预定义时间控制，这使得水下机器人-机械臂系统的控制性能存在着部分缺陷。首先在控制约束方面，现有的控制方法大多是局部约束或输出约束，不能保证系统的稳定性。其次，从时间上看，现有的控制算法都需要很长的时间才能完成，不能达到跟随高度的要求。此外，现有的控制系统架构比较复杂，在实际应用中也不方便。
5、故通过以上分析，本专利技术对障碍函数和性能函数进行结合，确定一种全状态约束下的水下机器人-机械臂系统的预定义时间控制方法。
技术实现思路
1、本专利技术为了解决目前水下机器人机械臂系统的控制方法应用时存在的控制精度有限的问题、虚拟控制率求导时可能会存在计算爆炸的问题、达到稳定状态收敛时间估计无法预测的问题以及当前技术尚无全状态约束下的预定义时间控制器设计等问题，提出了一种水下机器人机械臂的预定义时间轨迹跟踪控制方法。
2、本专利技术的技术方案是：一种水下机器人机械臂的预定义时间轨迹跟踪控制方法包括以下步骤：
3、s1、构建水下机器人机械臂的动力学模型；
4、s2、根据水下机器人机械臂的动力学模型j构建水下机器人机械臂的跟踪误差；
5、s3、构建非对称障碍函数，确定水下机器人机器臂的全状态约束；
6、s4、根据水下机器人机械臂的跟踪误差以及全状态约束，确定水下机器人机械臂的辅助虚拟控制率；
7、s5、根据水下机器人机械臂的辅助虚拟控制率，确定水下机器人机械臂的控制率。
8、进一步地，s1中，水下机器人机械臂的动力学模型的表达式为：
9、
10、式中，表示水下机器人机械臂位置的导数，表示水下机器人机械臂速度的导数，x1表示水下机器人机械臂位置，x2表示水下机器人机械臂速度，m表示惯性矩阵，c(·)表示科里奥利力/力矩，d(·)表示水动力升力和阻尼矩阵，g(·)表示恢复力和力矩，τ表示作用在水下机器人机械臂上的力/力矩矢量，a表示水下机器人机械臂加速度。
11、进一步地，s2中，水下机器人机械臂的跟踪误差的表达式为：
12、
13、式中，表示水下机器人机械臂位置误差的导数，表示水下机器人机械臂速度误差的导数，表示水下机器人机械臂位置的导数，表示水下机器人机械臂速度的导数，x2表示水下机器人机械臂速度，表示期望轨迹，表示虚拟控制率。
14、进一步地，s3中，非对称障碍函数vc的表达式为：
15、
16、式中，γui表示位置误差上限，γli表示位置误差下限，ci表示位置误差。
17、进一步地，s4包括以下子步骤：
18、s41、根据水下机器人机器臂的全状态约束，构建第一lyapunov函数，并对第一lyapunov函数进行求导，得到第一lyapunov偏导函数；
19、s42、根据水下机器人机械臂的跟踪误差，对第一lyapunov偏导函数进行优化，得到lyapunov优化函数；
20、s43、根据lyapunov优化函数，计算水下机器人机械臂的辅助虚拟控制率。
21、进一步地，s41中，第一lyapunov函数v1(x)的表达式为：
22、
23、式中，γui表示位置误差上限，γli表示位置误差下限，η表示第一障碍函数，z1表示水下机器人机械臂位置误差；
24、s41中，第一lyapunov偏导函数的表达式为：
25、
26、式中，表示第一障碍函数的导数，ρ1i表示第一障碍函数中上界与下界之间的变量，表示水下机器人机械臂位置误差的导数，ξ1i表示第一障碍函数中下界与位置误差之间的变量，表示第一障碍函数中上界与位置误差之间的变量，表示位置误差上限的导数，表示位置误差下限的导数。
27、进一步地，s42中，lyapunov优化函数的表达式为：
28、
29、式中，η表示第一障碍函数，ρ1i表示第一障碍函数中上界与下界之间的变量，ξ1i表示第一障碍函数中下界与位置误差之间的变量，表示第一障碍函数中上界与位置误差之间的变量，z2表示水下机器人机械臂速度误差，θ表示虚拟控制率，表示期望轨迹的导数，表示位置误差上限的导数，表示位置误差下限的导数。
30、进一步地，s43中，水下机器人机械臂的辅助虚拟控制率的计算公式为：
31、
32、式中，η表示第一障碍函数，ρ1i表示障碍函数中上界与下界之间的变量，z2表示水下机器人机械臂速度误差，γ表示预定义时间的指数项参数，t0表示预定义时间的时间参数。
33、进一步地，s5包括以下子步骤：
34、s51、本文档来自技高网...
【技术保护点】
1.一种水下机器人机械臂的预定义时间轨迹跟踪控制方法，其特征在于，包括以下步骤：
2.根据权利要求1所述的水下机器人机械臂的预定义时间轨迹跟踪控制方法，其特征在于，所述S1中，水下机器人机械臂的动力学模型的表达式为：
3.根据权利要求1所述的水下机器人机械臂的预定义时间轨迹跟踪控制方法，其特征在于，所述S2中，水下机器人机械臂的跟踪误差的表达式为：
4.根据权利要求1所述的水下机器人机械臂的预定义时间轨迹跟踪控制方法，其特征在于，所述S3中，非对称障碍函数Vc的表达式为：
5.根据权利要求1所述的水下机器人机械臂的预定义时间轨迹跟踪控制方法，其特征在于，所述S4包括以下子步骤：
6.根据权利要求5所述的水下机器人机械臂的预定义时间轨迹跟踪控制方法，其特征在于，所述S41中，第一Lyapunov函数V1(x)的表达式为：
7.根据权利要求5所述的水下机器人机械臂的预定义时间轨迹跟踪控制方法，其特征在于，所述S42中，Lyapunov优化函数的表达式为：
8.根据权利要求5所述的水下机器人机械臂的预定
9.根据权利要求1所述的水下机器人机械臂的预定义时间轨迹跟踪控制方法，其特征在于，所述S5包括以下子步骤：
10.根据权利要求9所述的水下机器人机械臂的预定义时间轨迹跟踪控制方法，其特征在于，所述S51中，第二Lyapunov函数V2(x)的表示式为：
...【技术特征摘要】
1.一种水下机器人机械臂的预定义时间轨迹跟踪控制方法，其特征在于，包括以下步骤：
2.根据权利要求1所述的水下机器人机械臂的预定义时间轨迹跟踪控制方法，其特征在于，所述s1中，水下机器人机械臂的动力学模型的表达式为：
3.根据权利要求1所述的水下机器人机械臂的预定义时间轨迹跟踪控制方法，其特征在于，所述s2中，水下机器人机械臂的跟踪误差的表达式为：
4.根据权利要求1所述的水下机器人机械臂的预定义时间轨迹跟踪控制方法，其特征在于，所述s3中，非对称障碍函数vc的表达式为：
5.根据权利要求1所述的水下机器人机械臂的预定义时间轨迹跟踪控制方法，其特征在于，所述s4包括以下子步骤：
6.根据权利要求5所述的水下机器人机械...
【专利技术属性】
技术研发人员：刘海涛，杨敬卫，麦青群，林锦浩，田雪虹，郑永昌，
申请(专利权)人：广东海洋大学，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。