一、D-H参数法建模基础Denavit-Hartenberg（D-H）参数法是工业机器人运动学建模的核心方法。该方法用四个参数描述相邻连杆间的空间关系：连杆长度ai——沿Xi轴从Zi到Zi+1的距离；连杆扭角αi——绕Xi轴从Zi旋转到Zi+1的角度；关节偏距di——沿Zi轴从Xi-1到Xi的距离；关节角θi——绕Zi轴从Xi-1旋转到Xi的角度。坐标系建立遵循右手定则：Zi轴与关节i+1的轴线重合，Xi轴沿Zi-1与Zi的公垂线方向，Yi轴由右手定则确定。对于旋转关节，θi为变量；对于移动关节，di为变量。

二、六轴工业机器人D-H参数表实例以典型六轴串联机器人为例，其标准D-H参数如下表所示。该机器人六个关节均为旋转关节，θi为关节变量。

关节i	ai-1(mm)	αi-1(°)	di(mm)	θi(°)	关节范围(°)
1	0	0	290	θ1	±180
2	0	-90	0	θ2	-135~90
3	270	0	0	θ3	-160~280
4	70	-90	302	θ4	±360
5	0	90	0	θ5	±130
6	0	-90	72	θ6	±360

三、正运动学——齐次变换矩阵链式推导相邻连杆间的齐次变换矩阵由四个基本变换复合而成：

展开得标准形式。末端执行器位姿由六个变换矩阵连乘得到：

结果矩阵左上3×3子阵为末端姿态（旋转矩阵），第四列前三行为末端位置坐标。给定一组关节角即可唯一确定末端位姿，这是离线编程和轨迹规划的基础。

四、逆运动学解析法逆运动学已知末端位姿反求关节角，是机器人控制的关键。解析法包括：代数法——通过对T60等式两端依次左乘逆变换矩阵，分离变量求解各θi；几何法——将前三轴构成的定位机构投影到平面，利用余弦定理求解θ2和θ3，再利用投影角度求θ1；Pieper准则——当机器人后三轴轴线交于一点（球腕结构）时，逆运动学存在封闭解。绝大多数工业机器人满足Pieper准则，可将位置与姿态解耦：前三轴决定腕心位置，后三轴决定末端姿态，分别求解后组合得到全部8组解。

五、数值迭代法当解析解不存在时采用数值法：雅可比伪逆法——利用关节速度与末端速度的线性关系 q̇ = J+·v，其中J+ = JT(JJT)-1，迭代更新qk+1 = qk + α·J+·Δx，逐步逼近目标位姿。缺点是接近奇异构型时雅可比病态。改进方案阻尼最小二乘法（DLS）引入阻尼因子λ：J+ = JT(JJT + λ2I)-1，在精度与关节速度间取得平衡，有效抑制奇异性区域的关节速度突变。

六、多解筛选原则六轴机器人逆运动学存在多达8组解，工程中按以下优先级筛选：最短行程——选择与当前构型关节角变化量最小的解，减少运动时间；避障约束——排除使机械臂与工件、夹具、安全围栏发生碰撞的解；关节限位——剔除超出各关节物理限位范围的解；姿态偏好——优先选择肘部向上或向下、手腕翻转或非翻转等符合工艺要求的构型。

七、MATLAB Robotics Toolbox验证使用Peter Corke的Robotics Toolbox可快速验证：

>> L1 = Link('d',0.290,'a',0,'alpha',0);>> L2 = Link('d',0,'a',0,'alpha',-pi/2);>> L3 = Link('d',0,'a',0.270,'alpha',0);>> L4 = Link('d',0.302,'a',0.070,'alpha',-pi/2);>> L5 = Link('d',0,'a',0,'alpha',pi/2);>> L6 = Link('d',0.072,'a',0,'alpha',-pi/2);>> robot = SerialLink([L1 L2 L3 L4 L5 L6]);>> q = [0 0 0 0 0 0];>> T = robot.fkine(q);        % 正运动学>> q_sol = robot.ikine(T);    % 逆运动学数值解>> robot.teach();             % 可视化示教通过MATLAB仿真可以在实际部署前全面验证运动学模型的正确性，为轨迹规划和控制算法提供可靠的数学基础。