1.一種基于自適應(yīng)kmeans算法的機器人未知環(huán)境探索方法,其特征在于,包括以下步驟:
2.根據(jù)權(quán)利要求1所述的基于自適應(yīng)kmeans算法的機器人未知環(huán)境探索方法,其特征在于,基于rrt算法對所述未知區(qū)域進行識別得到邊界點,包括:
3.根據(jù)權(quán)利要求2所述的基于自適應(yīng)kmeans算法的機器人未知環(huán)境探索方法,其特征在于,通過計算兩點之間的歐幾里得距離和動態(tài)調(diào)整步長以適應(yīng)不同區(qū)域的探索需求,預(yù)設(shè)已知向量和向量并計算歐幾里得距離的表達式為:
4.根據(jù)權(quán)利要求3所述的基于自適應(yīng)kmeans算法的機器人未知環(huán)境探索方法,其特征在于,對探索到的邊界點進行管理,包括:
5.根據(jù)權(quán)利要求1所述的基于自適應(yīng)kmeans算法的機器人未知環(huán)境探索方法,其特征在于,采用kmeans算法對所述邊界點進行聚類處理,包括:
6.根據(jù)權(quán)利要求1所述的基于自適應(yīng)kmeans算法的機器人未知環(huán)境探索方法,其特征在于,基于teb路徑規(guī)劃算法引導(dǎo)所述機器人到達所述目標點,還包括:
7.根據(jù)權(quán)利要求6所述的基于自適應(yīng)kmeans算法的機器人未知環(huán)境探索方法,其特征在于,teb算法的第一個約束目標函數(shù)為跟隨路徑和避障約束,避障約束包括跟隨已知的全局規(guī)劃路和避障,構(gòu)型序列與全局路徑點序列或障礙物的最近距離為,跟隨路徑目標以構(gòu)型距全局路徑的允許最大距離作為約束,避障目標以構(gòu)型距障礙物的允許最小距離作為約束;
8.根據(jù)權(quán)利要求7所述的基于自適應(yīng)kmeans算法的機器人未知環(huán)境探索方法,其特征在于,teb算法的第二個約束目標函數(shù)為速度和加速度約束,機器人運動的平均線速度和角速度可通過相鄰的、和時間間隔計算得到:
9.根據(jù)權(quán)利要求7所述的基于自適應(yīng)kmeans算法的機器人未知環(huán)境探索方法,其特征在于,teb算法的第三個約束目標函數(shù)為運動學(xué)約束,機器人以若干弧段組成平滑的軌跡運動,初始與運動方向、的夾角應(yīng)與結(jié)束構(gòu)型對應(yīng)的夾角相等,若為機器人在第i段弧段相對于世界坐標系的絕對姿態(tài),則:
10.根據(jù)權(quán)利要求7所述的基于自適應(yīng)kmeans算法的機器人未知環(huán)境探索方法,其特征在于,teb算法的第四個約束目標函數(shù)為最快路徑約束,用最小化時間間隔序列的二次方表示: