Based on the inverse position equation and the jacobian matrix, the solution of direct position is obtained through the numerical iteration method.

• 在机构位置反解和速度雅可比矩阵的基础上，利用数值迭代的方法对机构进行了正解求解，每次可以求得机构的一组正解。