【導(dǎo)讀】對關(guān)節(jié)空間進(jìn)行插值。{S}的一系列運動。數(shù)描述機(jī)器人預(yù)期的運動;以X或q為依據(jù)設(shè)計控制規(guī)律??紤]路徑上是否存在障礙。速度連續(xù),各軸協(xié)調(diào)。行關(guān)節(jié)定時插補(bǔ)。直線需要示教兩點,圓弧需要示教三點;計算機(jī)利用插補(bǔ)算法獲得中間點的坐標(biāo);對于其他軌跡,可以采用直線或圓弧逼近,以。已知直線始末兩點的坐標(biāo)值P0(X0,Y0,設(shè)v為要求的沿直線運動的速度;ts為插補(bǔ)時間間隔。ts間隔內(nèi)行程:d=vts;插補(bǔ)總步數(shù)N:L/d+1,取整;P2、P3及對應(yīng)姿態(tài)。計算P1、P2、P3決定的圓弧半徑R。把該點的坐標(biāo)值轉(zhuǎn)變?yōu)榛A(chǔ)坐標(biāo)系下的值。里完成一次插補(bǔ)運算和一次逆向運動學(xué)計算)。兩插補(bǔ)點的距離PiPi+1恒為一個足夠小的值,以保證軌跡精度,ts就要變化。關(guān)節(jié)變量的容許范圍等。若對于運動軌跡的要求更為嚴(yán)格,約束條件增多,