DH 描述

每组四个参数 $theta, d, alpha, a$,其中 $theta$ 是逆解中待确定的值,其他为固定值 确定了 6 组参数以后可以确定 ori 和 pos