关键词:
聚变装置
机械臂
主从遥操作
目标检测
力反馈辅助
摘要:
聚变装置的定期检修和维护是确保其正常运行的关键。由于装置内部环境恶劣(真空、高辐射等),需要采用远程遥操作方式进行维护。目前,全自主远程遥操作受传感和控制技术的制约,短期内难以完全应用于维护中;传统主从远程遥操作使用“人在环中”的策略,维护中依赖操作人员的技能水平,存在安全性和效率低下的问题。因此,亟需更加智能、高效、稳定的聚变装置主从遥操作维护技术,作为传统主从到全自主维护的过渡。依托CMOR(中国聚变堆维护多功能重载机械臂系统),针对其末端FLMS(聚变装置轻型臂维护系统)在主从遥操作中存在的两大问题进行研究:一是非接触任务中目标接近效率低、安全性不足;二是接触任务中的装配反馈力临场感较差。为解决上述问题,论文开展了非接触任务中FLMS目标检测定位算法、主端力辅助控制策略、精确从端机械臂避障以及接触性任务中的高保真装配反馈力方法研究,主要研究内容如下:
(1)为解决FLMS非接触性主从遥操作系统在操作中的目标检测定位问题,提出一种轻量化高精度的目标检测算法。该方法建立以YOLOv5s为基础的目标检测框架。针对遥操作维护系统对检测网络计算资源占用率低、检测精度高的要求,采用深度可分离卷积的轻量化C3Ghost模块代替原Neck层中的C3模块,完成了网络轻量化的改进;引入高效推理的Sim SPPF模块,提高模型前向传播速度;引入高宽比解耦的EIOU边框回归损失函数,提高目标定位精度。基于上述方法,完成轻量化高精度的目标检测定位算法GSE-YOLOv5 s构建。在测试集上进行验证表明,相较于原始YOLOv5s,GSE-YOLOv5网络参数量减少了13.8%,检测精度提升了1.4%。检测实验表明GSE-YOLOv5降低了目标漏检率和误检率。
(2)为解决FLMS非接触性主从遥操作主端无辅助的低效操作问题,提出了一种视觉力辅助策略,提高主端操作效率。该策略首先通过几何法和MDH法分别建立了主从端的运动学模型。随后,利用蒙特卡洛方法对主从端的可达空间进行分析,并据此设计了两种适应非接触性和接触性操作的异构主从遥操作控制方法。进一步地,采用了深度视觉检测与人工势场技术的结合,完成主端辅助力模型的构建了。在此基础上,遵循手眼一致性原则,结合张正友法和Tsai法,建立了从端辅助力到主端辅助力的映射规则。最后,构建了一套完整的主端视觉力辅助控制框架。为了验证该框架的稳定性,构建了李雅普诺夫函数,并证明了在主端视觉力辅助控制下,系统能够实现渐进稳定。
(3)为解决FLMS非接触性精确主从遥操作从端无自主避障的问题,开发了一种基于非线性模型预测控制(NMPC)的精确从端辅助避障控制器。首先,分析了从端系统在维护任务中的同时满足从端跟随主端指令的轨迹跟踪与避障的多任务特性,构建了一个包含自定义权重的目标函数。使用球与圆柱体包络从端对象,定义碰撞约束,并采用并行算法实现了避障问题的实时求解。为了增强从端被控系统的建模精度,建立了一个包含七个方程和七个未知数的双臂标定模型。然后,提出了一种结合Gr(?)bner基和Levenberg-Marquardt算法的双臂标定求解方法。通过Gr(?)bner基法筛选出平均标定误差最小的初始解,提高了非线性最小二乘法在求解双臂标定问题时的收敛速度和求解数值稳定性。最后,在精确的标定算法和智能NMPC控制器的协同作用下,从端系统能够自主避障,提升了从端系统的智能性和鲁棒性。
(4)为解决FLMS接触性主从遥操作装配中力反馈的临场感差问题,建立了一套高保真的主从力反馈装配模型框架。首先,基于最小二乘法,完成了真实反馈力耦合参数的辨识。基于辨识参数,完成了反馈力补偿算法的构建。然后,提出了一种非凸形状模块化网格构建方法,提高了虚拟场景中的非凸面体碰撞网格精度,为虚拟场景提供真实反馈力奠定基础。最后,以聚变维护中典型的轴孔装配任务为背景,完成了模拟主从虚拟装配系统的构建。实验结果表明:力反馈补偿算法的实时性和鲁棒性满足装配任务需求,模拟轴孔装配具有较好的临场感。
(5)为验证以上方法在FLMS主从遥操作系统中的应用效果。首先,构建了基于GSE-YOLOv5的实时定位检测系统,验证了在不同维护工况下,算法满足高精度与实时性检测需求。然后,搭建了视觉力辅助主从遥操作平台,进行了有/无力辅助情况下的主从遥操作指定目标接近实验,结果表明:相比无力辅助操作,视觉力辅助下的主端操作效率提高了近一倍。开展双臂标定实验,通过激光跟踪仪完成双臂末端位姿的采集,利用标定算法求解出双臂基座间相对位姿残差降小于1.5mm。基于标定结果搭建了从端系统模型。在主端辅助力操作下,进行了从端执行臂快速接近期望位置实验,整个过程,执行臂与辅助臂都能规划最优无碰撞轨迹。最后,搭建了实际轴孔装配平台,通过完成多组轴孔装配任务,验证了虚拟场景与实际场景