一種面向無人自行車的人工勢場路徑規(guī)劃法

基本信息

申請?zhí)?/td> CN201710210981.6 申請日 -
公開(公告)號 CN106843235B 公開(公告)日 2019-04-12
申請公布號 CN106843235B 申請公布日 2019-04-12
分類號 G05D1/02(2006.01)I 分類 控制;調(diào)節(jié);
發(fā)明人 不公告發(fā)明人 申請(專利權(quán))人 深圳市靖洲科技有限公司
代理機(jī)構(gòu) - 代理人 -
地址 518000 廣東省深圳市南山區(qū)西麗街道留仙大道2012號新圍大廈103B-1號
法律狀態(tài) -

摘要

摘要 本發(fā)明提供了一種面向無人自行車的人工勢場局部路徑規(guī)劃法,包括:(1)初始化環(huán)境信息,確定無人自行車的初始位置、目標(biāo)點(diǎn)位置和障礙物信息;(2)獲取周圍障礙物的信息,計算障礙物對無人自行車的影響距離及障礙物與目標(biāo)位置的距離;(3)計算無人自行車在當(dāng)前位置所受的引力與斥力,改進(jìn)斥力勢場函數(shù)和斥力函數(shù)后,計算合力的大小與方向;(4)引導(dǎo)無人自行車行進(jìn)到下一個地點(diǎn);(5)判斷是否陷入局部最小點(diǎn),如是則轉(zhuǎn)入步驟(6),否則轉(zhuǎn)入步驟(7);(6)加入虛擬障礙物,斥力場為Ja,轉(zhuǎn)入步驟(2);(7)若有虛擬障礙物,將其刪除,判斷無人自行車是否到達(dá)目標(biāo)位置或行走完規(guī)定距離,若是則結(jié)束,否則轉(zhuǎn)到步驟(2)。