[发明专利]一种基于FPGA的七自由度空间机械臂运动学实时解算方法无效
| 申请号： | 201310419763.5 | 申请日： | 2013-09-16 |
| 公开（公告）号： | CN103499922A | 公开（公告）日： | 2014-01-08 |
| 发明（设计）人： | 叶平;韩亮亮;孙汉旭;贾庆轩;吉雪 | 申请（专利权）人： | 北京邮电大学 |
| 主分类号： | G05B13/04 | 分类号： | G05B13/04 |
| 代理公司： | 暂无信息 | 代理人： | 暂无信息 |
| 地址： | 100876 *** | 国省代码： | 北京;11 |
| 权利要求书： | 查看更多 | 说明书： | 查看更多 |
| 摘要： | 本发明公开了一种基于FPGA的七自由度空间机械臂运动学实时解算方法。该运动学解算方法分为五个功能模块，分别是求解正余弦模块、正解模块、求解雅克比矩阵模块、求逆模块以及求解关节角速度模块。由正余弦模块计算出机械臂各关节角度的正余弦值，输入给正解模块求解齐次变换矩阵，然后在雅克比矩阵模块中，通过齐次变换矩阵计算相对于末端坐标系的雅克比矩阵的每一列，经过计算可以得到相对于基坐标系的雅克比矩阵和一个满秩方阵，输出满秩方阵给求逆模块进行求逆，当求逆运算完成以后输出给求解关节角速度模块与相对于基坐标系的雅克比矩阵的转置相乘，得到雅克比矩阵的伪逆，最后乘上末端速度得到各个关节的角速度，完成整个运动学解算。 | ||
| 搜索关键词： | 一种 基于 fpga 自由度 空间 机械 运动学 实时 方法 | ||
【主权项】：
一种基于FPGA的七自由度空间机械臂运动学实时解算方法，其特征在于，包括求解正余弦模块、正解模块、求解雅克比矩阵模块、求逆模块以及求解关节角速度模块。由正余弦模块计算出机械臂各关节角度的正余弦值，输入给正解模块求解各齐次变换矩阵，然后在雅克比矩阵模块中，通过齐次变换矩阵计算相对于末端坐标系的雅克比矩阵的每一列，经过计算可以得到相对于基坐标系的雅克比矩阵和一个满秩方阵，输出满秩方阵给求逆模块进行求逆，当求逆运算完成以后输出给求解关节角速度模块与相对于基坐标系的雅克比矩阵的转置相乘，得到雅克比矩阵的伪逆，最后乘上末端速度得到各个关节的角速度，实现整个运动学解算，所有模块中的数据均采用定点数表示。
下载完整专利技术内容需要扣除积分，VIP会员可以免费下载。
该专利技术资料仅供研究查看技术是否侵权等信息，商用须获得专利权人授权。该专利全部权利属于北京邮电大学，未经北京邮电大学许可，擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作，请联系【客服】
本文链接：http://www.vipzhuanli.com/patent/201310419763.5/，转载请声明来源钻瓜专利网。
