示教机器人多空间轨迹规划的平滑过渡方法及装置
基本信息
申请号 | CN201710762197.6 | 申请日 | - |
公开(公告)号 | CN107571261B | 公开(公告)日 | 2019-10-22 |
申请公布号 | CN107571261B | 申请公布日 | 2019-10-22 |
分类号 | B25J9/22 | 分类 | 手动工具;轻便机动工具;手动器械的手柄;车间设备;机械手; |
发明人 | 糜凯;王云宽;吴少泓;胡建华;郑军;王欣波;苏婷婷;张好剑 | 申请(专利权)人 | 中国科学院自动化研究所(洛阳)机器人与智能装备创新研究院 |
代理机构 | 北京瀚仁知识产权代理事务所(普通合伙) | 代理人 | 郭文浩;王世超 |
地址 | 100080 北京市海淀区中关村东路95号 | ||
法律状态 | - |
摘要
摘要 | 本发明涉及机器人轨迹规划领域,提出示教机器人多空间轨迹规划的平滑过渡方法,旨在解决轨迹切换过程中的不平滑问题。方法为:解析机器人示教程序,判断轨迹规划的切换方向,若轨迹规划为从笛卡尔空间向关节空间切换,获取笛卡尔空间轨迹规划的末端点,根据路径及速度的要求,获得末端点处的第一位姿和第一速度,并利用雅可比矩阵求得各关节的第一角速度,以第一位姿所指示角度为起点角度,以第一角速度为起点速度进行关节空间轨迹规划;否则,获取笛卡尔空间轨迹规划的起始点,求得起始点处的第二位姿及各关节的第二角速度,以第二位姿所指示的角度为终点角度,以第二角速度为终点速度进行关节空间轨迹规划。实现轨迹规划在空间切换的平滑过渡。 |
