article-六轴机械臂(带抓手)运动学分析+轨迹规划 D-h表如下****正运动学分析%输入JD,即6个关节变量的值,求解正运动方程T =[end%JD为输入的1*6的数组,代表6个关节变量endend。