关键词:
移动机械臂
柔顺控制
传感器融合
开门规划
车臂协同
摘要:
移动机械臂开门技术主要用于应对核辐射核污染等人类无法进入的环境中的救援任务,实现自主规划开门作业,但目前移动机械臂开门技术主要存在三个方面的主要问题:(1)感知系统需要对门把手位置及门的开度进行检测;(2)自主路径规划局部避障对移动平台的规划能力要求较高;(3)开门任务需要移动机械臂能够实现车臂协同及阻抗自适应控制。因此,本文对移动机械臂的柔顺开门任务进行了以下研究:
首先,在开门任务中移动机械臂需要准确的获取门与门把手的位置信息以及门开度信息,本文采用双目相机与激光雷达结合的方式对门与门把手进行检测定位,对Yolov5s网络进行SPP模块的改进,利用双目相机得到门与门把手的三维位置信息,提出了特征值法对RANSAC算法进行改进,通过雷达融合相机检测得到的位置信息对门的点云进行平面拟合,并计算门的开合角度,实现对门的开度大小的判断。
其次,为了实现移动机械臂能够自主避障并对准门把手,本文提出了两段式PID控制算法,控制横向误差与航向角偏差,实现移动平台的对准任务;本文针对人工势场法中局部最优与目标点不可达的问题提出了改进措施,利用障碍物的势场范围与轨迹路径建立横纵向子目标点,并对斥力场函数进行势场力的分解,提高了移动平台实时躲避障碍物并到达目标点的能力。
然后,为了完成移动机械臂开门任务中的柔顺性与车臂协同,本文提出了基于力偏差的模型参考自适应阻抗控制,将机械臂等效为二阶物理模型,分析了机械臂在与环境接触时产生的期望力误差,并对阻抗参数的影响进行分析,提出将模型参考自适应控制与阻抗控制相结合的策略,实现对机械臂的柔顺控制;本文对机械臂与移动平台进行车臂协同规划,借助感知系统输出的门开度夹角对机械臂末端速度与车速实现速度耦合,同时规划共同完成开门任务。
最后,搭建移动机械臂开门实验平台,并对本文提出的一系列方法进行实验验证。实验证明,移动平台能够精准的躲避路径上的多个障碍物并对准门把手,满足任务的需求;移动机械臂能够实现车臂协同柔顺开门,车与臂同时运动过程中保证机械臂末端在世界坐标系下的运动轨迹为绕门轴的圆弧运动,实现了机械臂与移动平台的耦合控制。本文研究成果可用于机器人军事、医疗等领域,为移动机械臂柔顺开门等提供技术参考及解决方案。