水下机器人控制方法、装置及水下机器人控制系统与流程
本发明涉及水下智能作业,具体涉及水下机器人控制方法、装置及水下机器人控制系统。
背景技术:
1、水下机器人是海洋探测与资源开发的核心装备,在深海作业、油气工程、环境监测和应急救援等领域发挥不可替代作用,水下机器人的水下机械臂的远程遥控操作精度将直接决定水下任务成功率。现有技术通常通过获取感知数据直接控制机械臂,并在动力学建模时将浮力与重力合并等效处理来计算控制力矩。
2、然而,现有技术在实际应用时对感知数据缺乏数据预测,难以准确确定操作者的运动意图和预测参考轨迹;且无法区分流体扰动,未独立前馈补偿粘性阻力力矩、附加质量力矩和单独求解的浮力力矩,导致机械臂进行轨迹跟踪时受流体扰动产生漂移。
3、因此,亟需一种能够对感知数据进行数据预测并独立前馈补偿的水下机械臂控制方法。
技术实现思路
1、针对上述问题,本技术提供水下机器人控制方法,用于提升水下机械臂轨迹跟踪精度与水下作业执行效果。技术方案如下:
2、第一方面,本发明提供了水下机器人控制方法,应用于水下机器人,水下机器人搭载有用于执行水下作业的机械臂,水下机器人与遥控操作设备通过双向长时延通信链路连接,遥控操作设备用于操作者对机械臂进行手动控制,包括:
3、获取操作者在操作遥控操作设备时所产生的多模态感知数据,对多模态感知数据进行数据预测,确定操作者的运动意图和预测参考轨迹;
4、获取机械臂的连杆几何参数,对连杆几何参数进行流体动力学解算,得到流体前馈补偿力矩,流体前馈补偿力矩为包括粘性阻力力矩、附加质量力矩和单独求解的浮力力矩的总流体动力学载荷;
5、获取机械臂的刚体基础控制力矩,将刚体基础控制力矩与流体前馈补偿力矩进行叠加处理,得到总驱动力矩;
6、根据总驱动力矩驱动机械臂进行轨迹跟踪以执行水下作业。
7、结合第一方面和上述实现方式,在某些可能的实现方式中,对连杆几何参数进行流体动力学解算,得到流体前馈补偿力矩,包括:
8、对连杆几何参数进行齐次变换矩阵求解处理,得到连杆质心雅可比矩阵;
9、基于莫里森方程对连杆质心雅可比矩阵进行积分处理,得到粘性阻力力矩和附加质量力矩;
10、基于连杆质心雅可比矩阵对单连杆浮力进行映射处理,得到单独求解的浮力力矩;
11、将粘性阻力力矩、附加质量力矩和单独求解的浮力力矩进行叠加,得到流体前馈补偿力矩。
12、结合第一方面和上述实现方式,在某些可能的实现方式中,对多模态感知数据进行数据预测,确定操作者的运动意图和预测参考轨迹,包括:
13、对多模态感知数据进行复合滤波处理,得到降噪感知数据;
14、基于降噪感知数据进行时空配准融合处理,得到统一时空对齐的融合特征;
15、对统一时空对齐的融合特征进行意图时序推理与轨迹预测,确定操作者的运动意图和预测参考轨迹,预测参考轨迹为用于补偿双向长时延通信链路时延的未来轨迹。
16、结合第一方面和上述实现方式,在某些可能的实现方式中,对多模态感知数据进行复合滤波处理,得到降噪感知数据之前,包括:
17、获取操作者的肌电信号幅值;
18、基于肌电信号幅值进行疲劳度量化处理,得到疲劳状态值;
19、在疲劳状态值超过预设阈值时,进行控制权重平滑切换处理,得到动态人机混合控制权重指令,动态人机混合控制权重指令为用于调节操作者手动控制与水下机器人自主控制分配比例的指令。
20、结合第一方面和上述实现方式,在某些可能的实现方式中,根据总驱动力矩驱动机械臂进行执行轨迹跟踪以执行预设的水下作业之后,包括:
21、获取机械臂的末端力传感器所采集的水下交互力;
22、基于双向长时延通信链路将水下交互力回传至遥控操作设备,以对操作者进行力反馈提示。
23、结合第一方面和上述实现方式,在某些可能的实现方式中,还包括:
24、获取双向长时延通信链路的传输数据,传输数据包括预测参考轨迹和机械臂的关节状态与末端交互力;
25、基于波变量能量成形模型对传输数据进行无源性约束处理,得到满足能量守恒约束的波变量信号,波变量信号用于抑制通信时延引起的系统震荡;
26、通过双向长时延通信链路对波变量信号进行双向传输处理。
27、结合第一方面和上述实现方式,在某些可能的实现方式中,还包括:
28、获取多流速洋流扰动样本;
29、将水下作业产生的数据、预测参考轨迹与多流速洋流扰动样本进行叠加扩充处理,得到扩充训练样本;
30、基于扩充训练样本对动态运动基元模型进行更新与校正处理,生成技能轨迹,动态运动基元模型为用于生成抗洋流扰动的稳定作业轨迹的模型;
31、将技能轨迹进行分层存储处理,得到轨迹技能库。
32、结合第一方面和上述实现方式,在某些可能的实现方式中,将技能轨迹进行分层存储处理,得到轨迹技能库之后,包括:
33、获取待处理水下任务的任务轨迹;
34、将任务轨迹与轨迹技能库进行检索匹配处理,得到匹配技能轨迹;
35、基于实时流体动力学模型对匹配技能轨迹进行自适应修正,生成目标执行轨迹,应用目标执行轨迹以控制机械臂执行待处理水下任务。
36、第二方面,本发明还提供了一种水下机器人控制装置,其特征在于,应用于水下机器人,水下机器人搭载有用于执行水下作业的机械臂,水下机器人与遥控操作设备通过双向长时延通信链路连接,遥控操作设备用于操作者对机械臂进行手动控制,包括:
37、数据预测单元,用于获取操作者在操作遥控操作设备时所产生的多模态感知数据,对多模态感知数据进行数据预测,确定操作者的运动意图和预测参考轨迹;
38、补偿力矩获取单元,用于获取机械臂的连杆几何参数,对连杆几何参数进行流体动力学解算,得到流体前馈补偿力矩,流体前馈补偿力矩为包括粘性阻力力矩、附加质量力矩和单独求解的浮力力矩的总流体动力学载荷;
39、总驱动力矩获取单元,用于获取机械臂的刚体基础控制力矩,将刚体基础控制力矩与流体前馈补偿力矩进行叠加处理,得到总驱动力矩;
40、作业执行单元,用于根据总驱动力矩驱动机械臂进行轨迹跟踪以执行水下作业。
41、第三方面,本发明还提供了一种水下机器人控制系统,包括通信模块、传感组件、机械臂驱动组件、存储器以及处理器,其中,
42、通信模块,用于通过双向长时延通信链路接收操作者的多模态感知数据,并发送机械臂的关节状态与末端交互力;
43、传感组件,用于获取机械臂的连杆几何参数以及末端交互力;
44、机械臂驱动组件,用于在处理器的控制下驱动机械臂执行轨迹跟踪以进行水下作业;
45、存储器,用于存储可执行程序代码;
46、处理器,用于对多模态感知数据进行数据预测,确定操作者的运动意图和预测参考轨迹,预测参考轨迹为用于补偿双向长时延通信链路时延的未来轨迹;对连杆几何参数进行流体动力学解算,得到流体前馈补偿力矩;获取机械臂的刚体基础控制力矩,将刚体基础控制力矩与流体前馈补偿力矩进行叠加处理,得到总驱动力矩;根据总驱动力矩控制机械臂驱动组件驱动机械臂进行轨迹跟踪以执行预设的水下作业。
47、第四方面,本发明还提供了一种计算机可读存储介质,用于存储计算机可读取的程序或指令,程序或指令被处理器执行时能够实现上述任意实现方式中的水下机器人控制方法中的步骤。
48、本发明的有益效果是:通过采集操作者操控遥控设备过程中产生的多模态感知数据,基于多模态感知数据开展时序预测运算,精准辨识操作者运动意图并输出预测参考轨迹,避免了传统方案运动意图识别精度不足的缺陷。针对现有技术将浮力、重力合并等效计算带来的误差弊端,本技术采集水下机械臂各连杆几何参数,依托流体动力学模型完成解算求解,得到流体前馈补偿力矩;该补偿力矩由粘性阻力力矩、附加质量力矩以及独立解算的浮力力矩共同构成,完整表征水下环境总流体动力学载荷。随后获取机械臂刚体基础控制力矩,将刚体基础控制力矩与流体前馈补偿力矩叠加运算,合成总驱动力矩;最终依托总驱动力矩驱动水下机械臂完成轨迹跟踪与水下作业任务,大幅抑制流体扰动引发的轨迹漂移现象,显著提升水下机械臂轨迹跟踪精度与水下作业执行效果。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com