dobot类机械臂运动学

dobot机械臂运动学，正逆运动学求解。姿态有点问题 但位置是对的 需要的也是位置 但每个关节有角度范围限制 因为有反三角函数存在 即使用atan2也不行 因为sin由cos而来 后续有时间回找一下sin的其他 求没范围限制的