做机械臂导航时遇到的问题7：正向运动学求解：在关节空间进行规划