ROS 一種路徑優化方法 拉直法

2021-10-09 11:37:00 字數 1187 閱讀 6423

如圖:

1、設路徑點為陣列p[end],end為乙個大於2的整數。

2、從路徑乙個點p[x]開始嘗試與路徑上其他的點p[x+2]~p[n]~p[end]拉直,若能拉直則刪除px與pn之間所有的路徑點(不包括px和pn)。

3、x取值範圍[0,end-3],依次增大,每次加1,x每加1需要與n為[x+2,end]上所有的點做拉直計算。

4、n的取值範圍[x+2,end]。

5、當x >= end-2,演算法結束。

參考**:

bool path_optimization::

collision

(costmap_2d::costmap2d* costmap,

const

double x,

const

double y)

bool path_optimization::

islinefree

(costmap_2d::costmap2d* costmap,

const geometry_msgs::posestamped pose1,

const geometry_msgs::posestamped pose2)

else

return

true;}

}void path_optimization::

cutpathpoint

(costmap_2d::costmap2d* costmap, std::vector<:posestamped>

&plan)

else

}else}}

}

ROS 一種基於RRT的路徑規劃器

最近寫了乙個基於rrt的全域性路徑規劃器在此記錄下來。ubuntu18.04 ros melodic 作為move base外掛程式。包括rrt rrt connect,啟發式擴充套件,路徑優化等內容。過載!一般為機械人起始點和目標點 然後規劃這兩個點之間的路徑。函式為 bool rrtstarpl...

oracle 多表查詢的一種優化方法

要用到4張表進行多表查詢 表1 jw jh x y 3000 記錄 表2 djqkgx jh qkdyid 3000 記錄 表3 qkxx id qkdy 100以內 表4 dba01 jh rcyl1 rq 42萬 現在已知 qkdy,rq 要查 max a.x max a.y min a.x m...

一種HBase表資料遷移方法的優化

1.背景調研 目前存在的hbase資料遷移主要分如下幾類 根據上圖,可以看出 其實主要分為兩種方式 1 hadoop層 因為hbase底層是基於hdfs儲存的,所以可以通過把hdfs上的資料拷貝的方式來實現,即 distcp。2 hbase層 主要是基於hbase資料層的 copytable 需要s...