机械臂正逆运动学求解

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