DH (Denavit- Hartenberg) 法在matlab robotics toolbox中有SDH和MDH之分。

我先看的Craig的书，我自己一般习惯用MDH，但是后来上课的时候又是讲的SDH法，整得我很分裂，现在看Bruno Siciliano的Robotics也是用的SDH法，两种DH参数法用起来容易混，在这里进行一下区分。

其实两种方法的区别主要在于{0}的选择，从而导致了后面坐标系的小区别，link parameters的意义都是相同的。 两种方法大同小异，结果都是相同的，凭个人喜好选择即可。

这种DH法是John J. Craig. Introduction to Robotics: Mechanics and Control 上面讲的。他自己也说这个方法和别的书不太一样，所以可能才叫Modified DH吧？

Note that many related conventions go by the name Denavit–Hartenberg, but differ in a few details. For example, the version used in this book differs from some of the robotic literature in the manner of frame numbering. Unlike some other conventions, in this book frame {i} is attached to link i and has its origin lying on joint axis i.

Link parameters表示frame{i-1}到frame{i}的变换 T i − 1 i T_{i-1}^i Ti−1i​。从base{0}开始到6轴{6}结束，也可以到工具坐标系{T}结束。

其中连杆长度 a a a和扭转角 α \alpha α反应了轴 i-1 和 轴 i 的关系，偏距 d d d 反应了连杆 i-1 和 连杆 i 的关系。

以6轴机械臂为例，Frame {i} 由{i}和{i+1}确定（i=0, 1, 2, 3, 4, 5)，下面是确定 frame {i}的步骤。

根据上述规则确定了frame{1} ~ {6}，我们可以把frame {0}设为与{1}重合，以便让尽可能多的DH参数为0。确定了{0}~{6}之后，便可以写DH参数了。

注意{6}并不是工具坐标系{T}，而是6轴所在的坐标系，可以再加一个{6} -> {T}的DH参数，一般末端到工具坐标系的变换为一个固定的刚体变换。

定义了关节坐标系之后，我们再来看连杆参数在坐标系中的含义。

注意：我这里的下标都统一改成i了，和表1中的下标不一致。这是因为我一般在写某个关节坐标系{i}的DH参数时，我希望下标统一，而不是有的i-1有的是i，我这里手动修改了下标看起来更加顺眼。

下面是{i}到{i+1}的变换矩阵 T i i + 1 = [ c o s θ − s i n θ 0 a s i n θ c o s α c o s θ c o s α − s i n α − d s i n α s i n θ s i n α c o s θ s i n α c o s α d c o s α 0 0 0 1 ] T_i^{i+1} = \begin{bmatrix} cos\theta & -sin\theta & 0 & a \\ sin\theta cos\alpha & cos\theta cos\alpha & -sin\alpha & -dsin\alpha \\ sin\theta sin\alpha & cos\theta sin\alpha & cos\alpha & dcos\alpha \\ 0 & 0 & 0 & 1 \end{bmatrix} Tii+1​=⎣⎢⎢⎡​cosθsinθcosαsinθsinα0​−sinθcosθcosαcosθsinα0​0−sinαcosα0​a−dsinαdcosα1​⎦⎥⎥⎤​

这个方法是Bruno Siciliano. Robotics Modelling, Planning and Control 里面讲的。因为两种方法其实很相似，SDH我就不讲太详细了。

下面是{i}到{i+1}的变换矩阵 T i i + 1 = [ c o s θ − c o s α s i n θ s i n α s i n θ a c o s θ s i n θ c o s θ c o s α − s i n α c o s θ − a s i n θ 0 s i n α c o s α d 0 0 0 1 ] T_i^{i+1} = \begin{bmatrix} cos\theta & -cos\alpha sin\theta & sin\alpha sin\theta & acos\theta \\ sin\theta & cos\theta cos\alpha & -sin\alpha cos\theta & -asin\theta \\ 0 & sin\alpha & cos\alpha & d \\ 0 & 0 & 0 & 1 \end{bmatrix} Tii+1​=⎣⎢⎢⎡​cosθsinθ00​−cosαsinθcosθcosαsinα0​sinαsinθ−sinαcosθcosα0​acosθ−asinθd1​⎦⎥⎥⎤​

我直接从Bruno Siciliano的书上截下来了一页。SDH方法的结果见左图。

右图为 MDH方法，结果如下图所示。可以看到两种方法最终求得的刚体变换是相同（废话）。

第4组其实是到末端单独的一组变换，这样算出来结果跟SDH法是相同的

通过对比可以发现，SDH比MDH领先一个轴，主要是因为MDH的{0}与{1}是重合的，而SDH的{0}是1轴，{1}是2轴，所以形式上SDH比MDH更加简洁一点点。