机械臂正逆运动学求解

我做的是五轴机械臂,但他们的Z轴除了最后一轴都是平行的,导致角度太过复杂算不出,希望帮忙求解一下,下面是它的D-H坐标

img