六轴机器人matlab写运动学逆解函数(改进DH模型)
1.理论 本文采用的模型为之前博客“ matlab机器人工具箱一般六轴的DH模型和改进DH模型建立与区别 ”里面的改进DH模型,参数不再重复给出。 基系与工具坐标系关系为: b T 0 ( 0 T 1 1 T 2 2 T 3 3 T 4 4 T 5 5 T 6 ) 6 T e = b T e b T 0 ( 0 T 1 1 T 2 2 T 3 3 T 4 4 T 5 5 T 6 ) 6 T e = b T e 将逆运动学问题简化为: 0 T 1 1 T 2 2 T 3 3 T 4 4 T 5 5 T 6 = b T 1 0 b T e 6 T 1 e 0 T 1 1 T 2 2 T 3 3 T 4 4 T 5 5 T 6 = b T 0 1 b T e 6 T e 1 2.转换为下式求解 2 T 3 3 T 4 4 T 5 = 1 T 1 2 0 T 1 1 b T 1 0 b T e 6 T 1 e 5 T 1 6 2 T 3 3 T 4 4 T 5 = 1 T 2 1 0 T 1 1 b T 0 1 b T e 6 T e 1 5 T 6 1 左边: left = [ cos (theta3)* cos (theta4)* cos (theta5) - sin (theta3)* sin (theta5), - cos (theta5)* sin (theta3) - cos