发明名称 |
一种机器人末端位姿分析方法 |
摘要 |
本发明涉及一种机器人末端位姿分析方法,以连杆长度、关节转角、连杆距离和连杆转角四个构型参数表示各轴间的转换矩阵,以三次旋转轴的旋转角度来表示机器人末端相对参考坐标系的姿态,包括:通过正向运动学利用各轴间的转换矩阵和三次旋转轴推导出机器人末端相对参考坐标系的位置和姿态;比较末端点预计位置与末端点实际位置,算出速度修正量;利用角速度转换矩阵算出末端点预期速度,加入速度修正量后得到末端点速度;再利用逆向运动学将得到的机器人末端相对参考坐标系的速度转换为各关节的角速度;控制各关节角速度在最大速度限制之下,将各关节的角速度加上目前位置得到各关节所需的转动角度。本发明处理过程简单,且能够确保一定的精度。 |
申请公布号 |
CN106514636A |
申请公布日期 |
2017.03.22 |
申请号 |
CN201611168697.9 |
申请日期 |
2016.12.16 |
申请人 |
宁波帝洲自动化科技有限公司 |
发明人 |
廖赐洲 |
分类号 |
B25J9/04(2006.01)I;B25J9/16(2006.01)I |
主分类号 |
B25J9/04(2006.01)I |
代理机构 |
上海泰能知识产权代理事务所 31233 |
代理人 |
宋缨;钱文斌 |
主权项 |
一种机器人末端位姿分析方法,其特征在于,以连杆长度、关节转角、连杆距离和连杆转角四个构型参数表示各轴间的转换矩阵,以三次旋转轴的旋转角度来表示机器人末端相对参考坐标系的姿态,包括以下步骤:(1)通过正向运动学利用各轴间的转换矩阵和三次旋转轴推导出机器人末端相对参考坐标系的位置和姿态;(2)比较末端点预计位置与末端点实际位置,算出速度修正量;(3)利用角速度转换矩阵算出末端点预期速度,加入速度修正量后得到末端点速度;(4)再通过逆向运动学利用雅克比矩阵将得到的机器人末端相对参考坐标系的速度转换为各关节的角速度;(5)控制各关节角速度在最大速度限制之下,将各关节的角速度加上目前位置得到各关节所需的转动角度。 |
地址 |
315800 浙江省宁波市北仑区新碶莫干山路36号A幢1号-105 |