在基架與地之間添加固定副,在關(guān)節(jié)1、關(guān)節(jié)2、關(guān)節(jié)3、關(guān)節(jié)4、關(guān)節(jié)5及關(guān)節(jié)6添加旋轉(zhuǎn)副(revolute joint),如圖2所示。在添加運(yùn)動(dòng)約束的時(shí)候,會(huì)產(chǎn)生I-Marker和J-Marker兩個(gè)坐標(biāo)系[1,2],調(diào)整這兩個(gè)坐標(biāo)系的方向,使其符合D-H參數(shù)[3]。表1所示為所建模型的D-H參數(shù)表。