一种移动机械臂柔顺开门运动规划方法及系统

    公开(公告)号:CN118404583A

    公开(公告)日:2024-07-30

    申请号:CN202410619318.1

    申请日:2024-05-19

    IPC分类号: B25J9/16

    摘要: 本发明提供一种移动机械臂柔顺开门运动规划方法及系统,属于机器人运动规划领域。为解决现有机械臂完成开门任务时,由于移动平台与机械臂末端自身控制存在误差,导致旋拧把手及推拉门时会出现真实运动与设计轨迹不完全重合,造成开门失败或机械臂损坏的问题。包括计算出机械臂力域中的雅可比矩阵,将关节转矩与末端外力联系到一起,根据机械臂输出的各关节转矩计算得到末端所受环境外力;在笛卡尔空间控制机械臂末端执行器,在关节空间对关节控制;通过阻抗控制系统,可以显著降低运动干涉问题;将移动机械臂开门任务分解为四个次要任务,并针对每个次要任务提出了相对独立的控制器设计方法,实现车臂协同任务,显著提高开门效率和成功率。

    一种基于传感器融合的门与门把手定位检测方法及系统

    公开(公告)号:CN118534471A

    公开(公告)日:2024-08-23

    申请号:CN202410619321.3

    申请日:2024-05-19

    摘要: 本发明提供一种基于传感器融合的门与门把手定位检测方法及系统,属于图像处理领域。为解决现有移动机械臂利用雷达点云读取目标信息时,检测效果不佳,未考虑机械臂末端不在平面内做圆弧运动,轨迹规划难度高和精度较差的问题。包括建立感知系统坐标系,获取相机与激光雷达之间的变换矩阵,利用YOLOv5s目标检测算法检测门与门把手,基于雷达点云的门平面及开度检测,对雷达点云进行划分和分割,再对点云进行平面拟合,得到门平面的法向量,进而对门开度进行检测,得到门的开合角度。通过计算移动平台和门把手之间的方向误差,有效降低对规划精准度的要求;通过推算门平面的开度,有效提高开门成功率,便于移动平台后续的定位导航和规划。