本申請涉及礦用卡車,具體涉及一種礦卡的泊車規(guī)劃方法、裝置及礦卡。
背景技術(shù):
1、目前,礦產(chǎn)資源產(chǎn)量巨大,取之可以保障生產(chǎn)生活,在礦業(yè)生產(chǎn)中,礦卡的泊車規(guī)劃是確保礦區(qū)作業(yè)效率和安全性的關(guān)鍵環(huán)節(jié)。但是,露天礦山土方剝離施工過程中的挖掘機工作面現(xiàn)場工況復(fù)雜,礦卡停靠過近會導(dǎo)致貨箱與工作面的坡面碰撞,??窟^遠則會導(dǎo)致挖掘機裝載困難,工作效率低,無法為礦卡泊車提供合適的??康攸c,使得裝載和卸載作業(yè)時,面臨諸多挑戰(zhàn)。
技術(shù)實現(xiàn)思路
1、為了解決上述技術(shù)問題,提出了本申請。本申請的實施例提供了一種礦卡的泊車規(guī)劃方法、裝置及礦卡,可以優(yōu)化礦卡泊車位置,使礦卡的泊車位置安全且能夠保障挖掘機的裝載效率。
2、根據(jù)本申請的第一方面,提供了一種礦卡的泊車規(guī)劃方法,包括:基于礦卡工作的目標礦山場景,獲取挖掘工作面和礦卡的可行駛區(qū)域;根據(jù)所述挖掘工作面和所述可行駛區(qū)域,確定礦卡的安全可達區(qū)域;基于挖掘機的機構(gòu)特性,獲取挖掘機的優(yōu)質(zhì)工作空間;基于所述安全可達區(qū)域以及挖掘機的優(yōu)質(zhì)工作空間的重合區(qū)域,確定礦卡的泊車點;其中,所述挖掘機在所述優(yōu)質(zhì)工作空間中的工作性能優(yōu)于非優(yōu)質(zhì)工作空間的工作性能;根據(jù)所述礦卡的預(yù)設(shè)起點以及所述泊車點,規(guī)劃所述礦卡的泊車方案。
3、作為一種可能的實現(xiàn)方式,根據(jù)所述挖掘工作面和所述可行駛區(qū)域,確定礦卡的安全可達區(qū)域,包括:以在所述可行駛區(qū)域中,且與所述挖掘工作面間隔預(yù)設(shè)距離的區(qū)域作為所述安全可達區(qū)域。
4、作為一種可能的實現(xiàn)方式,基于所述安全可達區(qū)域以及挖掘機的優(yōu)質(zhì)工作空間的重合區(qū)域,確定礦卡的泊車點,包括:基于所述安全可達區(qū)域以及挖掘機的優(yōu)質(zhì)工作空間的重合區(qū)域,確定礦卡的泊車區(qū)域;基于礦卡的預(yù)設(shè)姿態(tài),以礦卡的貨箱中心、前端、后端三個位置,分別匹配所述泊車區(qū)域中所述挖掘機的工作性能;當在礦卡的貨箱中心、前端、后端三個位置處,所述挖掘機的工作性能均大于預(yù)設(shè)工作性能時,確定所述礦卡的泊車點。
5、作為一種可能的實現(xiàn)方式,根據(jù)所述礦卡的預(yù)設(shè)起點以及所述泊車點,規(guī)劃所述礦卡的泊車方案,還包括:根據(jù)所述礦卡的預(yù)設(shè)起點以及所述泊車點,生成泊車路徑;基于杜賓斯曲線方法,規(guī)劃礦卡的所述泊車路徑的空間幾何路線;采用多項式方法對所述空間幾何路線隨時間變化的關(guān)系進行擬合,求解得到起始位姿到終點位姿的時空軌跡;其中,所述起始位姿包括所述預(yù)設(shè)起點的位置和姿態(tài)、所述中間過渡點的位置和姿態(tài)、所述終點位姿包括所述中間過渡點的位置和姿態(tài)、所述泊車點的位置和姿態(tài),所述時空軌跡反映礦卡在時間和空間范圍內(nèi)的運動路徑和狀態(tài)。
6、作為一種可能的實現(xiàn)方式,采用多項式方法對所述空間幾何路線隨時間變化的關(guān)系進行擬合,求解得到起始位姿到終點位姿的時空軌跡,包括:采用三次多項式對所述空間幾何路線隨時間變化的關(guān)系進行擬合,獲得在單段泊車線路行駛過程中泊車路徑隨時間的變化的關(guān)系式;基于泊車路徑隨時間的變化的關(guān)系式,獲得速度和加速度隨時間變化的關(guān)系式;基于礦卡的機構(gòu)特性,獲取礦卡泊車時的約束條件;基于速度和加速度隨時間變化的關(guān)系式以及所述約束條件,獲得起始位姿到終點位姿的時空軌跡。
7、作為一種可能的實現(xiàn)方式,根據(jù)所述礦卡的預(yù)設(shè)起點以及所述泊車點,生成泊車路徑,包括:在所述礦卡的預(yù)設(shè)起點以及所述泊車點之間,基于所述礦卡的運行工況,設(shè)置中間過渡點;其中,所述運行工況包括向前行駛以及向后倒車,所述中間過渡點的橫坐標位于所述預(yù)設(shè)起點與所述泊車點之間,所述中間過渡點的縱坐標根據(jù)所述礦卡的轉(zhuǎn)彎半徑的兩倍設(shè)定;基于所述中間過渡點,將所述礦卡的預(yù)設(shè)起點以及所述泊車點之間的泊車路徑分為兩段路徑;其中,第一段路徑為從所述預(yù)設(shè)起點至所述中間過渡點,第二段路徑為從所述中間過渡點到所述泊車點。
8、作為一種可能的實現(xiàn)方式,挖掘機包括動臂和斗桿,基于挖掘機的機構(gòu)特性,獲取挖掘機的優(yōu)質(zhì)工作空間,包括:基于挖掘機的機構(gòu)特性,確定動臂和斗桿的運動和力傳遞指標;基于動臂和斗桿的運動和力傳遞指標,獲得綜合性能指標;其中,所述綜合性能指標用于反映挖掘機的運動性能;基于所述綜合性能指標中大于或等于預(yù)設(shè)閾值的優(yōu)質(zhì)綜合性能指標,生成挖掘機的優(yōu)質(zhì)工作空間。
9、作為一種可能的實現(xiàn)方式,基于礦卡工作的目標礦山場景,獲取挖掘工作面和礦卡的可行駛區(qū)域,包括:基于礦卡工作的目標礦山場景,提取目標挖掘區(qū)域的幾何面貌,獲得挖掘工作面;識別礦卡工作的目標礦山場景中的障礙物,并基于所述障礙物的位置生成礦卡的可行駛區(qū)域。
10、根據(jù)本申請的第二方面,提供了一種礦卡的泊車規(guī)劃裝置,包括:第一獲取模塊,用于基于礦卡工作的目標礦山場景,獲取挖掘工作面和礦卡的可行駛區(qū)域;第一確定模塊,用于根據(jù)所述挖掘工作面和所述可行駛區(qū)域,確定礦卡的安全可達區(qū)域;第二獲取模塊,用于基于挖掘機的機構(gòu)特性,獲取挖掘機的優(yōu)質(zhì)工作空間;第二確定模塊,用于基于所述安全可達區(qū)域以及挖掘機的優(yōu)質(zhì)工作空間的重合區(qū)域,確定礦卡的泊車點;其中,所述挖掘機在所述優(yōu)質(zhì)工作空間中的工作性能優(yōu)于非優(yōu)質(zhì)工作空間的工作性能;規(guī)劃模塊,用于根據(jù)所述礦卡的預(yù)設(shè)起點以及所述泊車點,規(guī)劃所述礦卡的泊車方案。
11、根據(jù)本申請的第三方面,提供了一種礦卡,包括:貨箱;如上述第二方面所述的礦卡的泊車規(guī)劃裝置。
12、本申請?zhí)峁┑牡V卡的泊車規(guī)劃方法、裝置及礦卡,綜合考慮挖掘工作面、可行駛區(qū)域以及挖掘機的優(yōu)質(zhì)工作空間,求解得到礦卡與挖掘機協(xié)同作業(yè)的泊車點,礦卡可以基于泊車方案安全行駛到泊車點,并且使貨箱處于挖掘機優(yōu)質(zhì)工作空間,挖掘機能夠在貨箱位置處高效完成物料裝載,達到礦卡與挖掘機的高效協(xié)同作業(yè)。
1.一種礦卡的泊車規(guī)劃方法,其特征在于,包括:
2.根據(jù)權(quán)利要求1所述的礦卡的泊車規(guī)劃方法,其特征在于,根據(jù)所述挖掘工作面和所述可行駛區(qū)域,確定礦卡的安全可達區(qū)域,包括:
3.根據(jù)權(quán)利要求1所述的礦卡的泊車規(guī)劃方法,其特征在于,基于所述安全可達區(qū)域以及挖掘機的優(yōu)質(zhì)工作空間的重合區(qū)域,確定礦卡的泊車點,包括:
4.根據(jù)權(quán)利要求1所述的礦卡的泊車規(guī)劃方法,其特征在于,根據(jù)所述礦卡的預(yù)設(shè)起點以及所述泊車點,規(guī)劃所述礦卡的泊車方案,還包括:
5.根據(jù)權(quán)利要求4所述的礦卡的泊車規(guī)劃方法,其特征在于,采用多項式方法對所述空間幾何路線隨時間變化的關(guān)系進行擬合,求解得到起始位姿到終點位姿的時空軌跡,包括:
6.根據(jù)權(quán)利要求4所述的礦卡的泊車規(guī)劃方法,其特征在于,根據(jù)所述礦卡的預(yù)設(shè)起點以及所述泊車點,生成泊車路徑,包括:
7.根據(jù)權(quán)利要求1所述的礦卡的泊車規(guī)劃方法,其特征在于,挖掘機包括動臂和斗桿,基于挖掘機的機構(gòu)特性,獲取挖掘機的優(yōu)質(zhì)工作空間,包括:
8.根據(jù)權(quán)利要求1所述的礦卡的泊車規(guī)劃方法,其特征在于,基于礦卡工作的目標礦山場景,獲取挖掘工作面和礦卡的可行駛區(qū)域,包括:
9.一種礦卡的泊車規(guī)劃裝置,其特征在于,包括:
10.一種礦卡,其特征在于,包括: