一种应用于六轴机械手臂的空间平滑停止控制方法
基本信息
申请号 | CN201710747184.1 | 申请日 | - |
公开(公告)号 | CN107598921B | 公开(公告)日 | 2018-07-03 |
申请公布号 | CN107598921B | 申请公布日 | 2018-07-03 |
分类号 | B25J9/16 | 分类 | 手动工具;轻便机动工具;手动器械的手柄;车间设备;机械手; |
发明人 | 许可;胡春旭;潘北川;黄邵波 | 申请(专利权)人 | 深圳星河智能科技有限公司 |
代理机构 | 深圳市顺天达专利商标代理有限公司 | 代理人 | 郭伟刚 |
地址 | 518000 广东省深圳市前海深港合作区前湾一路1号A栋201室(入驻深圳市前海商务秘书有限公司) | ||
法律状态 | - |
摘要
摘要 | 本发明提供一种应用于六轴机械手臂的空间平滑停止控制方法,包括以下步骤,测得并输入六轴机械手臂开始减速的初始点信息,包括位置,速度和加速度,并且假设六轴机械手臂经过时间段T,减速后停止点信息是速度为0,加速度为0。采用五次方程式作为减速阶段的位置插补算法,计算出位置,速度和加速度分别和任一插补采样时间点的关系,从而实现对六轴机械手臂的空间平滑停止控制。该控制方法采用5次线性方程推导出减速停止过程中机械手臂的减速运动曲线,使其从减速到停止更为平滑,更符合电机运转特性,对电机冲力较小,起到了很好的保护作用,延长了使用寿命。 |
