發(fā)布時間：2024-02-02 14:48

　　為了保證冗余機(jī)械臂帶約束運(yùn)動規(guī)劃時的路徑連續(xù)性,針對目前的直接插值和連續(xù)插值方法潛在的約束失效和路徑失效問題,提出漸進(jìn)式約束擴(kuò)展的快速搜索隨機(jī)樹算法(PCE-RRT)。該算法在進(jìn)行搜索樹擴(kuò)展時引入了一種漸進(jìn)式約束擴(kuò)展方法,該方法使用帶有最近點信息的逆運(yùn)動學(xué)計算策略,可以在保證任務(wù)約束的情況下迭代縮短最近點和擴(kuò)展點的距離,讓每一次擴(kuò)展都能夠保證搜索樹的約束性和連續(xù)性。PCE-RRT可以使最終生成的搜索樹很好地貼合于約束流形子空間,且樹上任意兩個相連節(jié)點都能滿足連續(xù)條件。通過仿真實驗對算法進(jìn)行驗證,實驗結(jié)果表明該算法能夠為機(jī)械臂帶約束運(yùn)動規(guī)劃問題提供同時滿足約束性和連續(xù)性條件的路徑解。

【文章頁數(shù)】：5 頁

【部分圖文】：

圖1約束流形子空間插值的三種情形

為了避免直接插值和連續(xù)插值操作中潛在的約束失效和路徑失效問題，提出一種漸進(jìn)式約束擴(kuò)展方法，如圖1(d)～(f)所示。該方法會先計算qrand與qnear在位形空間中距離以判斷關(guān)節(jié)角是否會發(fā)生突變，導(dǎo)致機(jī)械臂的抖動現(xiàn)象，若無抖動則直接將qrand作為樹擴(kuò)展點，若出現(xiàn)抖動則進(jìn)一步在q....

圖2直接插值

使用直接插值方法時，由于直接插值法主要考慮的是讓插值點滿足位形空間的連續(xù)性，這使得插值過程中會出現(xiàn)機(jī)械臂不滿足約束的情況，如圖2所示。在從圖2(a)所示機(jī)械臂位形運(yùn)動到圖2(c)所示機(jī)械臂位形時，出現(xiàn)了圖2(b)中不滿足約束狀態(tài)的機(jī)械臂位姿，使得規(guī)劃失敗。使用連續(xù)插值方法時，連續(xù)....

圖3連續(xù)插值

使用連續(xù)插值方法時，連續(xù)插值法保證了規(guī)劃所得的整個路徑上的位形點都能滿足約束條件，但當(dāng)插值路徑本身存在問題時，會出現(xiàn)圖3中的情況，機(jī)械臂在從圖3(a)位形運(yùn)動至圖3(c)時，為了強(qiáng)行保證路徑的連續(xù)性，插入了如圖3(b)所示的無效機(jī)械臂位形，使整個規(guī)劃路徑失效。使用本文PCE-RR....

圖4漸進(jìn)約束擴(kuò)展插值

使用本文PCE-RRT算法進(jìn)行機(jī)械臂帶約束運(yùn)動規(guī)劃時，實驗效果如圖4所示。實驗結(jié)果中可以看到能夠為機(jī)械臂規(guī)劃出從起點到終點的一條連續(xù)約束路徑，并避免直接插值和連續(xù)插值所潛在的約束失效和路徑失效問題。2.2路徑連續(xù)性對比實驗

本文編號：3892838