基于改进人工势场法的人机安全避障路径规划方法

摘     要：本发明针对不同的障碍物与机械臂的速度关系，分别建立斥力场向量函数，并利用Pivot算法改进斥力场向量函数。首先，本发明通过Kinetic相机，获取障碍物，目标点以及机械臂的位姿关系。其次，本发明通过在机械臂末端执行器构造边界球，判断障碍物是否进入边界球并执行避障任务，定义引力场向量函数，再根据障碍物与机械臂的速度关系定义斥力场向量函数，主要考虑以下情况：1)障碍物快速接近机械臂，当速度vH＞vrobot_endm/s，所规划的新路径不能保证人体的安全，机械臂根据人的运动方向，通过Pivot算法优化斥力场向量函数；2)障碍物缓慢接近机械臂，当速度vH＜vrobot_endm/s，使用传统的斥力场向量函数。最后对引力以及斥力进行矢量合成，进行轨迹规划，生成避免碰撞的新路径，当机械臂陷入局部最小值时，引入时间因子，对机械臂产生一定扰动，快速脱离。如果人突然加速，应该对第一种情况做出反应。

著 录 项： 

• 1． 买家选定所需专利，确认国家手续办理方，下单，确认交易合同；
  2． 卖家确认专利可交易；
  3． 买家支付交易款项到平台；
  4． 买卖双方签订《专利转让委托书》、《转让协议》、《解除代理委托书》各一式两份并提交给办理国家手续方；
  5． 办理国家手续方提交办理官方手续，国家知识产权局1个月左右下发《著录项目变更手续合格通知书》；
  6． 买家确认收到《专利证书》、《著录项目变更手续合格通知书》；
  7． 平台把交易款项支付给卖家，至此专利转让合同完成。
  

• 交易方	企业	个人
  买家	营业执照副本复印件（需盖公章）	身份证复印件（签字）
  	专利转让委托书（需盖公章）一式两份	专利转让委托书（需签字）一式两份
  	专利转让协议（需盖公章）一式两份	专利转让协议（需签字）一式两份
  卖家	营业执照副本复印件（需盖公章）	身份证复印件（需申请人签字）
  	解除代理委托书（需盖公章）一式两份（如专利通过代理机构申请）	解除代理委托书（需签字）一式两份（如专利通过代理机构申请）
  	专利转让协议（需盖公章）一式两份	专利转让协议（需签字）一式两份
  	专利请求书或手续合格通知书、授权通知书复印件	专利请求书或手续合格通知书、专利授权通知书复印件
  	专利证原件（若授权下证）	专利证原件（若授权下证）

• 日期

  法律信息

  备注