[發明專利]運動規劃方法及裝置、存儲介質、電子裝置

有效

• 申請號: 202010654872.5
• 申請日: 2020-07-09
• 公開（公告）號: CN111531550B
• 公開（公告）日: 2020-11-06
• 發明（設計）人: 駱思宇;汪鵬飛;劉羽;盧維;任宇鵬;殷俊;周璐
• 申請（專利權）人: 浙江大華技術股份有限公司
• 主分類號: B25J9/16
• 分類號: B25J9/16
• 代理公司: 北京康信知識產權代理有限責任公司 11240
• 代理人: 江舟

本發明提供了一種運動規劃方法及裝置、存儲介質、電子裝置，所述方法包括：在采樣空間內確定起點位形和終點位形；將所述起點位形作為根節點建立第一隨機樹，將所述終點位形作為根節點建立第二隨機樹；在所述第一隨機樹中的第一目標節點和所述第二隨機樹中的第二目標節點之間的連線與障礙物未碰撞的情況下，確定出第一路徑；對所述第一路徑進行路徑優化，得到滿足預設約束的路徑。通過本發明，解決了路徑規劃的效率不高且耗時的問題，進而達到了加快收斂速度和優化搜索路徑的的效果。

技術領域

本發明涉及機器人技術、路徑規劃領域，具體而言，涉及一種運動規劃方法及裝置、存儲介質、電子裝置。

背景技術

運動規劃是指對于給定的起點和終點，使計算出滿足約束的路徑。比如針對固定場景，通過機器視覺技術構建環境，通過運動規劃完成機械臂的自主移動。

對于多自由度的機械臂的運動規劃，由于會進行多次的碰撞檢測，將會耗費大量時間，降低了運動規劃的效率。

針對相關技術中，路徑規劃的效率不高且耗時的問題，目前尚未存在有效的解決方案。

發明內容

本發明實施例提供了一種運動規劃方法及裝置、存儲介質、電子裝置，以至少解決相關技術中路徑規劃的效率不高且耗時的問題。

根據本發明的一個實施例，提供了一種運動規劃方法，包括：在采樣空間內確定起點位形和終點位形；將所述起點位形作為第一根節點建立第一隨機樹，將所述終點位形作為第二根節點建立第二隨機樹；在所述第一隨機樹中的第一目標節點和所述第二隨機樹中的第二目標節點之間的連線與障礙物無碰撞的情況下，確定出第一路徑；對所述第一路徑進行路徑優化，得到滿足預設約束的路徑。

在本發明的一個可選實施例中，對所述第一路徑進行路徑優化，得到滿足預設約束的路徑，包括：在所述第一路徑為初始路徑的情況下，通過縮短所述初始路徑得到作為滿足所述預設約束的路徑的優化路徑。

在本發明的一個可選實施例中，通過縮短所述初始路徑得到優化路徑，之后還包括：將所述采樣空間約束在根據所述優化路徑構造的預設形狀的立體空間內。

在本發明的一個可選實施例中，將所述起點位形作為第一根節點建立第一隨機樹，將所述終點位形作為第二根節點建立第二隨機樹，包括：在所述采樣空間內進行隨機采樣得到第一集合，其中，所述第一集合中是待添加到第一隨機樹中的多個無碰撞的采樣點集合；將所述起點位形作為第一根節點添加到第二集合中得到第一隨機樹，其中，所述第二集合中是已經被添加到第一隨機樹中的節點集合；將所述終點位形作為第二根節點添加到第二集合中得到第二隨機樹，其中，所述第二集合中是已經被添加到第二隨機樹中的節點集合。

在本發明的一個可選實施例中，確定在所述第一隨機樹中的第一目標節點和所述第二隨機樹中的第二目標節點，包括：在所述第一集合中搜索第一根節點的鄰點和第二根節點的鄰點，并將第一根節點的鄰點和第二根節點的鄰點作為新節點與相應的根節點相連；在所述新節點與所述相應的根節點之間的連線無碰撞的情況下，將所述鄰點從所述第一集合中刪除并添加到所述第二集合中；根據所述第二集合中確定出所述第一目標節點和第二目標節點。

在本發明的一個可選實施例中，確定在所述第一隨機樹中的第一目標節點和所述第二隨機樹中的第二目標節點之后還包括：搜索所述第二集合中新節點的鄰點，將在預設范圍內未找到無碰撞鄰點的新節點從所述第二集合中刪除，并將所述新節點添加到所述第一集合中。