1.建立DH坐标系
1.确定Zi轴（关节轴）
2.确定基础坐标系
3.确定Xi方向（垂直于zi和zi+1的平面）
4.完全确定各个坐标系
例子：
坐标系的布局是由个人决定的，可以有不同的选择
标准坐标系布局：
2.DH参数表
个人理解
a z轴之间的距离，看下一个
α 转角 看下一个，看z绕本次的x轴旋转多少度到下一个z轴
d x轴之间距离，x看前一个
theta 转角
顺时针为负，逆时针为正
别人的详细解析：（写得好好！）
机器人正向运动学和D-H参数方法_d-h参数法-CSDN博客
3.MATLAB示例
参考上图的DH参数表，将数据带入齐次变换矩阵中
clear;clc;
%%参数
L1=100;
L2=105;
L3=98;
L4=245;
IN_theta = [0,-45,10,10,0];%DH
C_a=[0,0,L2,L3,0,0,0];
C_d=[0,L1,0,0,0,0,L4];
C_alpha=[0,-90,0,0,-90,0,0];
C_theta=[0,IN_theta(1),IN_theta(2),IN_theta(3),IN_theta(4)-90,IN_theta(5),0];T_result = eye(4); % 初始化结果为单位矩阵for i = 1:6T = [cosd(C_theta(i+1)) -sind(C_theta(i+1)) 0 C_a(i-1+1);sind(C_theta(i+1))*cosd(C_alpha(i-1+1)) cosd(C_alpha(i-1+1))*cosd(C_theta(i+1)) -sind(C_alpha(i-1+1)) -sind(C_alpha(i-1+1))*C_d(i+1);sind(C_theta(i+1))*sind(C_alpha(i-1+1)) cosd(C_theta(i+1))*sind(C_alpha(i-1+1)) cosd(C_alpha(i-1+1)) cosd(C_alpha(i-1+1))*C_d(i+1);0 0 0 1]; % 根据给定的公式计算T[i]T_result = T_result * T; % 乘以每个T[i]
end