DH 描述

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