一种高自由度机器人逆运动学的快速求解方法及系统与流程

文档序号:12668763阅读:来源:国知局
技术总结
本发明提出一种高自由度机器人逆运动学的快速求解方法及系统,该方法包括步骤1,将关节变量θ带入机器人运动学方程中,获得雅克比矩阵J,将所述雅克比矩阵J进行转置,获得雅克比转置矩阵JT;步骤2,生成一组投机值,为每个投机值计算相应的关节变量更新值,将每个关节变量更新值带入机器人正运动学方程中,获得相应的位姿Pk,为每个位姿Pk计算其与目标位姿P的位姿偏差Δek,及位姿偏差Δek的模errork;步骤3,在模errork的集合中选取最小值errormin,及其对应的位姿偏差Δemin与关节变量更新值Δθmin,并更新位姿偏差为Δe=Δemin,更新关节变量θ=θ+Δθmin;步骤4,判断errormin是否满足errormin<Threshold,如果是,则输出关节变量θ并结束,否则,返至所述步骤1,继续执行。

技术研发人员:连世奇;韩银和;王颖;肖航
受保护的技术使用者:中国科学院计算技术研究所
文档号码:201710066204
技术研发日:2017.02.06
技术公布日:2017.06.13

当前第3页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1