一種車速規劃的方法、裝置和設備與流程

            文檔序號:12381939閱讀:211來源:國知局
            一種車速規劃的方法、裝置和設備與流程

            本發明涉及信息處理技術領域,特別是涉及一種車速規劃的方法、裝置和設備。



            背景技術:

            目前的汽車智能系統,不僅能夠為駕駛員提供導航路徑的規劃方案,而且也可以提供車速的規劃方案,以用于車輛行駛過程中的車速控制。在現有技術中,車速通常是依據車輛當前位置的前方障礙物進行控制的。具體地,系統可以根據雷達、相機等探測設備獲得車輛的前方障礙物的探測結果,然后根據前方障礙物的位置、速度等情況以及車輛自身的運動狀態與操作狀態規劃合適的車速跟隨前方障礙物,以便于規劃的車速用于實現車輛行駛過程中的車速控制。

            但發明人經過研究發現,一方面,雷達、相機等探測設備往往需要在足夠大的車速下才能啟動并獲得較為準確的探測結果,這就導致了車速的規劃不能適用于較小的車速,另一方面,在探測不到前方障礙物或探測到的前方障礙物過遠的情況下,規劃的車速不會受到任何限制,此時往往造成車速過快,這樣既不能保證車輛的行駛安全,也可能會給車內乘客造成不能承受的乘坐感受,還會造成能源的浪費。



            技術實現要素:

            本申請所要解決的技術問題是,提供一種車速規劃的方法、裝置和設備,以使得車速的規劃能夠適用于更廣泛的速度范圍、提高車輛的行駛安全和乘坐舒適程度并節省能源。

            第一方面,提供了一種車速規劃的方法,包括:

            根據目標前路的曲根率半徑,確定所述目標路徑點處的初始規劃速度,以使得第一側向加速度不大于側向加速度閾值,其中,所述目標前路為規劃路徑上以所述目標路徑點為起點的一段路徑,所述第一側向加速度為在所述目標前路上以所述目標路徑點處的初始規劃速度行駛而產生的側向加速度;

            根據參考前路的曲率半徑,確定所述參考路徑點處的初始規劃速度,以使得第二側向加速度不大于所述側向加速度閾值,其中,所述參考前路為所述規劃路徑上以所述參考路徑點為起點的一段路徑,所述第二側向加速度為在所述參考前路上以所述參考路徑點處的初始規劃速度行駛而產生的側向加速度;

            根據所述目標路徑點的初始規劃速度、所述參考路徑點的初始規劃速度和參考路程,確定所述目標路徑點處的目標縱向加速度和目標規劃速度,以使得所述目標縱向加速度在縱向加速度限定范圍以內,其中,所述參考路程表示在所述規劃路徑上從所述目標路徑點到所述參考路徑點的路程,所述目標縱向加速度表示在所述參考路程上由所述目標規劃速度變速成所述參考路徑點處的初始規劃速度所需的加速度。

            可選的,

            目標終點為在所述規劃路徑上距離所述目標路徑點路程最近的第一初始終點,所述目標終點為所述目標前路的終點,所述第一初始終點與所述目標路徑點的直線距離等于預設距離閾值;

            參考終點為在所述規劃路徑上距離所述參考路徑點路程最近的第二初始終點,所述參考終點為所述參考前路的終點,所述第二初始終點與所述參考路徑點的直線距離等于所述預設距離閾值。

            可選的,還包括:

            根據第一線段的長度、第二線段的長度以及所述第一線段與所述第二線段之間的夾角,計算第三線段的長度,作為所述目標前路的曲率半徑;其中,所述第三線段的兩個端點分別為所述目標前路的曲率中心和所述目標前路的中點,所述目標前路的曲率中心為第一垂線和第二垂線的交點,所述第一垂線垂直于第四線段且經過所述第四線段的中點,所述第二垂線垂直于第五線段且經過所述第五線段的中點,所述第一線段的兩個端點分別為所述第四線段的中點和所述目標前路的中點,所述第二線段的兩個端點分別為所述第五線段的中點和所述目標前路的中點,所述第四線段的兩個端點分別為所述目標路徑點和所述目標前路的中點,所述第五線段的兩個端點分別為所述目標前路的終點和所述目標前路的中點;

            根據第六線段的長度、第七線段的長度以及所述第六線段與所述第七線段之間的夾角,計算第八線段的長度,作為所述參考前路的曲率半徑;其中,所述第八線段的兩個端點分別為所述參考前路的曲率中心和所述參考前路的中點,所述參考前路的曲率中心為第三垂線和第四垂線的交點,所述第三垂線垂直于第九線段且經過所述第九線段的中點,所述第四垂線垂直于第十線段且經過所述第十線段的中點,所述第六線段的兩個端點分別為所述第九線段的中點和所述參考前路的中點,所述第七線段的兩個端點分別為所述第十線段的中點和所述參考前路的中點,所述第九線段的兩個端點分別為所述參考路徑點和所述參考前路的中點,所述第十線段的兩個端點分別為所述參考前路的終點和所述參考前路的中點。

            可選的,所述參考路程等于所述目標路徑點的初始規劃速度與預設時間閾值的乘積。

            可選的,所述根據所述目標路徑點的初始規劃速度、所述參考路徑點的初始規劃速度和參考路程,確定所述目標路徑點處的目標縱向加速度和目標規劃速度,以使得所述目標縱向加速度在縱向加速度限定范圍以內,包括:

            根據所述目標路徑點的初始規劃速度、所述參考路徑點的初始規劃速度和參考路程,計算初始縱向加速度,其中,所述初始縱向加速度表示在所述參考路程上由所述目標路徑點處的初始規劃速度變速成所述參考路徑點處的初始規劃速度所需的加速度;

            若所述目標路徑點處的初始縱向加速度表示減速運動且所述目標路徑點處的初始縱向加速度的絕對值未超過縱向加速度閾值,或者,若所述目標路徑點處的初始縱向加速度不表示減速運動,則將所述目標路徑點處的初始縱向加速度確定為所述目標縱向加速度,將所述目標路徑點處的初始規劃速度確定為所述目標規劃速度;

            若所述目標路徑點處的初始縱向加速度表示減速運動且所述目標路徑點處的初始縱向加速度的絕對值超過所述縱向加速度閾值,則減小所述目標路徑點處的初始規劃速度,返回執行所述計算初始縱向加速度的步驟。

            可選的,還包括:

            將所述目標規劃速度和所述目標縱向加速度保存到所述目標路徑點對應的規劃信息中,其中,所述目標路徑點的規劃信息中還包括所述目標路徑點的經緯度信息。

            可選的,所述目標路徑點對應的規劃信息還包括所述目標路徑點處的規劃航向和/或所述目標路徑點處的曲率半徑,所述目標路徑點處的規劃航向表示在所述目標路徑點處的行駛方向,所述目標路徑點處的曲率半徑為所述目標前路的曲率半徑。

            可選的,還包括:

            在車輛行駛過程中獲取當前行駛位置的經緯度信息;

            從所述目標路徑點對應的規劃信息中提取所述目標路徑點的經緯度信息;

            若所述當前行駛位置的經緯度信息與所述目標路徑點的經緯度信息相匹配,從所述目標路徑點對應的規劃信息中提取所述目標規劃速度和所述目標縱向加速度并依據所述目標規劃速度和所述目標縱向加速度對車速進行控制。

            第二方面,提供了一種車速規劃的裝置,包括:

            第一確定單元,用于根據目標前路的曲率半徑,確定所述目標路徑點處的初始規劃速度,以使得第一側向加速度不大于側向加速度閾值,其中,所述目標前路為規劃路徑上以所述目標路徑點為起點的一段路徑,所述第一側向加速度為在所述目標前路上以所述目標路徑點處的初始規劃速度行駛而產生的側向加速度;

            第二確定單元,用于根據參考前路的曲率半徑,確定所述參考路徑點處的初始規劃速度,以使得第二側向加速度不大于所述側向加速度閾值,其中,所述參考前路為所述規劃路徑上以所述參考路徑點為起點的一段路徑,所述第二側向加速度為在所述參考前路上以所述參考路徑點處的初始規劃速度行駛而產生的側向加速度;

            第三確定單元,用于根據所述目標路徑點的初始規劃速度、所述參考路徑點的初始規劃速度和參考路程,確定所述目標路徑點處的目標縱向加速度和目標規劃速度,以使得所述目標縱向加速度在所述縱向加速度范圍以內,其中,所述參考路程表示在所述規劃路徑上從所述目標路徑點到所述參考路徑點的路程,所述目標縱向加速度表示在所述參考路程上由所述目標規劃速度變速成所述參考路徑點處的初始規劃速度所需的加速度。

            可選的,目標終點為在所述規劃路徑上距離所述目標路徑點路程最近的第一初始終點,所述目標終點為所述目標前路的終點,所述第一初始終點與所述目標路徑點的直線距離等于預設距離閾值;參考終點為在所述規劃路徑上距離所述參考路徑點路程最近的第二初始終點,所述參考終點為所述參考前路的終點,所述第二初始終點與所述參考路徑點的直線距離等于所述預設距離閾值。

            可選的,還包括:

            第一計算單元,用于根據第一線段的長度、第二線段的長度以及所述第一線段與所述第二線段之間的夾角,計算第三線段的長度,作為所述目標前路的曲率半徑;其中,所述第三線段的兩個端點分別為所述目標前路的曲率中心和所述目標前路的中點,所述目標前路的曲率中心為第一垂線和第二垂線的交點,所述第一垂線垂直于第四線段且經過所述第四線段的中點,所述第二垂線垂直于第五線段且經過所述第五線段的中點,所述第一線段的兩個端點分別為所述第四線段的中點和所述目標前路的中點,所述第二線段的兩個端點分別為所述第五線段的中點和所述目標前路的中點,所述第四線段的兩個端點分別為所述目標路徑點和所述目標前路的中點,所述第五線段的兩個端點分別為所述目標前路的終點和所述目標前路的中點;

            第二計算單元,用于根據第六線段的長度、第七線段的長度以及所述第六線段與所述第七線段之間的夾角,計算第八線段的長度,作為所述參考前路的曲率半徑;其中,所述第八線段的兩個端點分別為所述參考前路的曲率中心和所述參考前路的中點,所述參考前路的曲率中心為第三垂線和第四垂線的交點,所述第三垂線垂直于第九線段且經過所述第九線段的中點,所述第四垂線垂直于第十線段且經過所述第十線段的中點,所述第六線段的兩個端點分別為所述第九線段的中點和所述參考前路的中點,所述第七線段的兩個端點分別為所述第十線段的中點和所述參考前路的中點,所述第九線段的兩個端點分別為所述參考路徑點和所述參考前路的中點,所述第十線段的兩個端點分別為所述參考前路的終點和所述參考前路的中點。

            可選的,所述參考路程等于所述目標路徑點的初始規劃速度與預設時間閾值的乘積。

            可選的,所述第三確定單元,包括:

            計算子單元,用于根據所述目標路徑點的初始規劃速度、所述參考路徑點的初始規劃速度和參考路程,計算初始縱向加速度,其中,所述初始縱向加速度表示在所述參考路程上由所述目標路徑點處的初始規劃速度變速成所述參考路徑點處的初始規劃速度所需的加速度;

            確定子單元,用于若所述目標路徑點處的初始縱向加速度表示減速運動且所述目標路徑點處的初始縱向加速度的絕對值未超過縱向加速度閾值,或者,若所述目標路徑點處的初始縱向加速度不表示減速運動,則將所述目標路徑點處的初始縱向加速度確定為所述目標縱向加速度,將所述目標路徑點處的初始規劃速度確定為所述目標規劃速度;

            減速子單元,用于若所述目標路徑點處的初始縱向加速度表示減速運動且所述目標路徑點處的初始縱向加速度的絕對值超過所述縱向加速度閾值,則減小所述目標路徑點處的初始規劃速度,并觸發所述計算子單元。

            可選的,還包括:

            保存單元,用于將所述目標規劃速度和所述目標縱向加速度保存到所述目標路徑點對應的規劃信息中,其中,所述目標路徑點的規劃信息中還包括所述目標路徑點的經緯度信息。

            可選的,所述目標路徑點對應的規劃信息例如還可以包括:所述目標路徑點處的規劃航向和/或所述目標路徑點處的曲率半徑,所述目標路徑點處的規劃航向表示在所述目標路徑點處的行駛方向,所述目標路徑點處的曲率半徑為所述目標前路的曲率半徑。

            可選的,還包括:

            獲取單元,用于在車輛行駛過程中獲取當前行駛位置的經緯度信息;

            提取單元,用于從所述目標路徑點對應的規劃信息中提取所述目標路徑點的經緯度信息;

            車速控制單元,用于若所述當前行駛位置的經緯度信息與所述目標路徑點的經緯度信息相匹配,從所述目標路徑點對應的規劃信息中提取所述目標規劃速度和所述目標縱向加速度并依據所述目標規劃速度和所述目標縱向加速度對車速進行控制。

            第三方面,提供了一種車速規劃的設備,包括處理器、存儲器、通信接口、總線系統;

            所述總線系統,用于將所述設備的各個硬件組件耦合在一起;

            所述通信接口,用于實現所述設備與至少一個其它設備之間的通信連接;

            所述存儲器,用于存儲程序指令和數據;

            所述處理器,用于讀取存儲器中存儲的指令和數據,執行以下操作:

            根據目標前路的曲率半徑,確定所述目標路徑點處的初始規劃速度,以使得第一側向加速度不大于側向加速度閾值,其中,所述目標前路為規劃路徑上以所述目標路徑點為起點的一段路徑,所述第一側向加速度為在所述目標前路上以所述目標路徑點處的初始規劃速度行駛而產生的側向加速度;

            根據參考前路的曲率半徑,確定所述參考路徑點處的初始規劃速度,以使得第二側向加速度不大于所述側向加速度閾值,其中,所述參考前路為所述規劃路徑上以所述參考路徑點為起點的一段路徑,所述第二側向加速度為在所述參考前路上以所述參考路徑點處的初始規劃速度行駛而產生的側向加速度;

            根據所述目標路徑點的初始規劃速度、所述參考路徑點的初始規劃速度和參考路程,確定所述目標路徑點處的目標縱向加速度和目標規劃速度,以使得所述目標縱向加速度在縱向加速度限定范圍以內,其中,所述參考路程表示在所述規劃路徑上從所述目標路徑點到所述參考路徑點的路程,所述目標縱向加速度表示在所述參考路程上由所述目標規劃速度變速成所述參考路徑點處的初始規劃速度所需的加速度。

            可選的,目標終點為在所述規劃路徑上距離所述目標路徑點路程最近的第一初始終點,所述目標終點為所述目標前路的終點,所述第一初始終點與所述目標路徑點的直線距離等于預設距離閾值;參考終點為在所述規劃路徑上距離所述參考路徑點路程最近的第二初始終點,所述參考終點為所述參考前路的終點,所述第二初始終點與所述參考路徑點的直線距離等于所述預設距離閾值。

            可選的,所述處理器還執行以下操作:

            根據第一線段的長度、第二線段的長度以及所述第一線段與所述第二線段之間的夾角,計算第三線段的長度,作為所述目標前路的曲率半徑;其中,所述第三線段的兩個端點分別為所述目標前路的曲率中心和所述目標前路的中點,所述目標前路的曲率中心為第一垂線和第二垂線的交點,所述第一垂線垂直于第四線段且經過所述第四線段的中點,所述第二垂線垂直于第五線段且經過所述第五線段的中點,所述第一線段的兩個端點分別為所述第四線段的中點和所述目標前路的中點,所述第二線段的兩個端點分別為所述第五線段的中點和所述目標前路的中點,所述第四線段的兩個端點分別為所述目標路徑點和所述目標前路的中點,所述第五線段的兩個端點分別為所述目標前路的終點和所述目標前路的中點;

            根據第六線段的長度、第七線段的長度以及所述第六線段與所述第七線段之間的夾角,計算第八線段的長度,作為所述參考前路的曲率半徑;其中,所述第八線段的兩個端點分別為所述參考前路的曲率中心和所述參考前路的中點,所述參考前路的曲率中心為第三垂線和第四垂線的交點,所述第三垂線垂直于第九線段且經過所述第九線段的中點,所述第四垂線垂直于第十線段且經過所述第十線段的中點,所述第六線段的兩個端點分別為所述第九線段的中點和所述參考前路的中點,所述第七線段的兩個端點分別為所述第十線段的中點和所述參考前路的中點,所述第九線段的兩個端點分別為所述參考路徑點和所述參考前路的中點,所述第十線段的兩個端點分別為所述參考前路的終點和所述參考前路的中點。

            可選的,所述參考路程等于所述目標路徑點的初始規劃速度與預設時間閾值的乘積。

            可選的,為了確定所述目標路徑點處的目標縱向加速度和目標規劃速度,所述處理器執行以下操作:

            根據所述目標路徑點的初始規劃速度、所述參考路徑點的初始規劃速度和參考路程,計算初始縱向加速度,其中,所述初始縱向加速度表示在所述參考路程上由所述目標路徑點處的初始規劃速度變速成所述參考路徑點處的初始規劃速度所需的加速度;

            若所述目標路徑點處的初始縱向加速度表示減速運動且所述目標路徑點處的初始縱向加速度的絕對值未超過縱向加速度閾值,或者,若所述目標路徑點處的初始縱向加速度不表示減速運動,則將所述目標路徑點處的初始縱向加速度確定為所述目標縱向加速度,將所述目標路徑點處的初始規劃速度確定為所述目標規劃速度;

            若所述目標路徑點處的初始縱向加速度表示減速運動且所述目標路徑點處的初始縱向加速度的絕對值超過所述縱向加速度閾值,則減小所述目標路徑點處的初始規劃速度,返回執行所述計算初始縱向加速度的步驟。

            可選的,所述處理器還執行以下操作:

            將所述目標規劃速度和所述目標縱向加速度保存到所述目標路徑點對應的規劃信息中,其中,所述目標路徑點的規劃信息中還包括所述目標路徑點的經緯度信息。

            其中,所述目標路徑點對應的規劃信息還包括所述目標路徑點處的規劃航向和/或所述目標路徑點處的曲率半徑,所述目標路徑點處的規劃航向表示在所述目標路徑點處的行駛方向,所述目標路徑點處的曲率半徑為所述目標前路的曲率半徑。

            可選的,所述處理器還執行以下操作:

            在車輛行駛過程中獲取當前行駛位置的經緯度信息;

            從所述目標路徑點對應的規劃信息中提取所述目標路徑點的經緯度信息;

            若所述當前行駛位置的經緯度信息與所述目標路徑點的經緯度信息相匹配,從所述目標路徑點對應的規劃信息中提取所述目標規劃速度和所述目標縱向加速度并依據所述目標規劃速度和所述目標縱向加速度對車速進行控制。

            在本申請提供的實施方式中,對于規劃路徑上的目標路徑點來說,用于在該目標路徑點處控制車速的目標規劃速度和目標縱向加速度是根據規劃路徑本身以及側向加速度閾值、縱向加速度限定范圍來確定的,可見,一方面,規劃路徑通過導航設備可以得到,導航設備并不像雷達、相機等探測設備那樣需要在一定的車速下才能使用,因此,車速的規劃可以適用于更廣泛的速度范圍,另一方面,在為目標路徑點規劃車速時以側向加速度閾值對目標路徑點處的側向加速度進行限制并以縱向加速度限定范圍對目標路徑點處的目標縱向加速度進行了限制,這使得在目標路徑點處按照目標規劃速度和目標縱向加速度控制行駛的車輛能夠避免劇烈的減速以及劇烈的側向偏移,從而不僅提高了車輛的行駛安全,而且還提高了車內乘客的乘坐舒適程度,并且還節省了能源。

            附圖說明

            為了更清楚地說明本發明實施例中的技術方案,下面將對實施例描述中所需要使用的附圖作簡單地介紹,顯而易見地,下面描述中的附圖僅僅是本申請中記載的一些實施例,對于本領域普通技術人員來講,還可以根據這些附圖獲得其他的附圖。

            圖1為本發明實施例中一應用場景所涉及的系統框架示意圖;

            圖2為本發明實施例中一種車速規劃的方法的流程示意圖;

            圖3為本發明實施例中一種目標前路的路徑示意圖;

            圖4為本發明實施例中一種目標前路的曲率半徑的示意圖;

            圖5為本發明實施例中一種車輛實際行駛目標前路的示意圖;

            圖6為本發明實施例中另一種車速規劃的方法的流程示意圖

            圖7為本發明實施例中一種車速規劃的裝置的結構示意圖;

            圖8為本發明實施例中一種車速規劃的設備的結構示意圖。

            具體實施方式

            為了使本技術領域的人員更好地理解本申請方案,下面將結合本申請實施例中的附圖,對本申請實施例中的技術方案進行清楚、完整地描述,顯然,所描述的實施例僅是本申請一部分實施例,而不是全部的實施例。基于本申請中的實施例,本領域普通技術人員在沒有做出創造性勞動前提下所獲得的所有其他實施例,都屬于本申請保護的范圍。

            發明人經過研究發現,一方面,雷達、相機等探測設備往往需要在足夠大的車速下才能啟動并獲得較為準確的探測結果,例如車速為40km/h以上,這就導致了車速的規劃不能適用于較小的車速,即不能適用于所有車速,而且雷達、相機等探測設備的成本較高,另一方面,在探測不到前方障礙物或探測到的前方障礙物過遠的情況下,不能根據相關環境信息設定或者調整車速,即規劃的車速不會受到任何限制,此時往往造成車速過快,這樣既不能保證車輛的行駛安全,也可能會給車內乘客造成不能承受的乘坐感受,還會造成能源的浪費。

            為了解決這一問題,在本發明實施例中,對于規劃路徑上的目標路徑點來說,用于在該目標路徑點處控制車速的目標規劃速度和目標縱向加速度是根據規劃路徑本身以及側向加速度閾值、縱向加速度限定范圍來確定的,可見,一方面,規劃路徑通過導航設備就可以得到,導航設備并不像雷達、相機等探測設備那樣需要在一定的車速下才能使用,因此,車速的規劃可以適用于更廣泛的速度范圍,另一方面,在為目標路徑點規劃車速時以側向加速度閾值對目標路徑點處的側向加速度進行限制并以縱向加速度限定范圍對目標路徑點處的目標縱向加速度進行了限制,這使得在目標路徑點處按照目標規劃速度和目標縱向加速度控制行駛的車輛能夠避免劇烈的減速以及劇烈的側向偏移,從而不僅提高了車輛的行駛安全,而且還提高了車內乘客的乘坐舒適程度,并且還節省了能源。

            舉例來說,本發明實施例的場景之一,可以是應用到如圖1所示的場景中。該場景包括導航設備101、處理器102和車速控制設備103,其中,導航設備101和處理器102可以進行交互,處理器102和車速控制設備103可以進行交互。導航設備101將規劃路徑的相關信息發送給處理器102。然后,處理器102根據目標前路的曲根率半徑,確定所述目標路徑點處的初始規劃速度,以使得第一側向加速度不大于側向加速度閾值,其中,所述目標前路為規劃路徑上以所述目標路徑點為起點的一段路徑,所述第一側向加速度為在所述目標前路上以所述目標路徑點處的初始規劃速度行駛而產生的側向加速度。以及,處理器102根據參考前路的曲率半徑,確定所述參考路徑點處的初始規劃速度,以使得第二側向加速度不大于所述側向加速度閾值,其中,所述參考前路為所述規劃路徑上以所述參考路徑點為起點的一段路徑,所述第二側向加速度為在所述參考前路上以所述參考路徑點處的初始規劃速度行駛而產生的側向加速度。再后,處理器102根據所述目標路徑點的初始規劃速度、所述參考路徑點的初始規劃速度和參考路程,確定所述目標路徑點處的目標縱向加速度和目標規劃速度,以使得所述目標縱向加速度在縱向加速度限定范圍以內,其中,所述參考路程表示在所述規劃路徑上從所述目標路徑點到所述參考路徑點的路程,所述目標縱向加速度表示在所述參考路程上由所述目標規劃速度變速成所述參考路徑點處的初始規劃速度所需的加速度。在車輛實際行駛過程中,處理器102根據所述目標縱向加速度和目標規劃速度輸出車速控制指令給車速控制設備103。

            可以理解的是,在上述應用場景中,雖然將本發明實施方式的動作描述由處理器102執行,但是本發明在執行主體方面不受限制,只要執行了本發明實施方式所公開的動作即可。

            可以理解的是,上述場景僅是本發明實施例提供的一個場景示例,本發明實施例并不限于此場景。

            下面結合附圖,通過實施例來詳細說明本發明實施例中車速規劃的方法、裝置和設備的具體實現方式。

            參見圖2,示出了本發明實施例中一種車速規劃的方法的流程示意圖。在本實施例中,所述方法例如具體可以包括如下步驟:

            步驟201:根據目標前路的曲率半徑,確定所述目標路徑點處的初始規劃速度,以使得第一側向加速度不大于側向加速度閾值,其中,所述目標前路為規劃路徑上以所述目標路徑點為起點的一段路徑,所述第一側向加速度為在所述目標前路上以所述目標路徑點處的初始規劃速度行駛而產生的側向加速度。

            步驟202:根據參考前路的曲率半徑,確定所述參考路徑點處的初始規劃速度,以使得第二側向加速度不大于所述側向加速度閾值,其中,所述參考前路為所述規劃路徑上以所述參考路徑點為起點的一段路徑,所述第二側向加速度為在所述參考前路上以所述參考路徑點處的初始規劃速度行駛而產生的側向加速度。

            具體實現時,可以先根據輸入的行駛起點和行駛終點為車輛生成規劃路徑,再分別為所述規劃路徑上的每一個路徑點確定初始規劃速度。可以理解的是,所述目標路徑點和所述參考路徑點是所述規劃路徑上的兩個不同的路徑點。在本實施例中,各個路徑點的初始規劃速度的確定順序可以不做限定。也即,本實施例對S201和S202的執行順序不做限定。例如,可以先執行S201再執行S202,也可以先執行S202再執行S201,還可以同時執行S201和S202。

            對于規劃路徑上的任意一個路徑點來說,該路徑點處的初始規劃速度用于約束車輛在該路徑點處行駛的側向加速度在預設的側向加速度閾值以內,從而提升行駛的安全性以及乘坐的舒適程度。由于該路徑點處的側向加速度與路徑點處的行駛速度和曲率半徑有關,因此,該路徑點處的初始規劃速度可以根據側向加速度閾值以及路徑點處的曲率半徑來確定。

            在本實施例中,對于規劃路徑上的任意一個路徑點來說,該路徑點處的曲率半徑可以以在規劃路徑上以該路徑點為起點的一段路徑的曲率半徑表示。該段路徑可以理解成在規劃路徑上該路徑點的前路,其終點可以依據該路徑點本身的位置與預設距離閾值來確定。具體地,以初始終點來表示在規劃路徑上與該路徑點之間直線距離等于預設距離閾值的其他路徑點,該路徑點的前路的終點可以是在規劃路徑上距離該路程點路程最近的一個初始終點。例如,對于規劃路徑上的所述目標路徑點來說,,目標終點為在所述規劃路徑上距離所述目標路徑點路程最近的第一初始終點,所述目標終點為所述目標前路的終點,所述第一初始終點與所述目標路徑點的直線距離等于預設距離閾值。其中,所述目標終點是位于所述目標路徑點的航向前方的路徑點。如圖3所示的示例,以目標路徑點為圓心并以預設距離閾值為半徑畫圓,圓周與規劃路徑的交點即為第一初始終點。當存在多個第一初始終點時,根據目標路徑點的規劃航向,在目標路程點的航向前方上距離所述目標路徑點路程最近的第一初始終點為目標終點,也即,根據目標路徑點的規劃航向,在圓周與規劃路徑的左右兩個交點中右側交點為目標終點。又如,對于規劃路徑上的所述參考路徑點來說,參考終點為在所述規劃路徑上距離所述參考路徑點路程最近的第二初始終點,所述參考終點為所述參考前路的終點,所述第二初始終點與所述參考路徑點的直線距離等于所述預設距離閾值。其中,所述參考終點是位于所述目標路徑點的航向前方的路徑點。

            需要說明的是,對于規劃路徑上的任意一個路徑點來說,若該路徑點的前路的終點被確定,則該路徑點的前路就被確定,此后可以為該路徑點的前路確定曲率半徑,以用于確定該路徑點處的初始規劃速度。在本實施例的一些實施方式中,為了簡化曲率半徑的計算過程,可以采用近似的算法,將該路徑點的前路近似地看成是一個圓弧,計算該圓弧的半徑作為該路徑點處的曲率半徑。

            例如,對于規劃路徑上的所述目標路徑點來說,本實施例在S201之前例如還可以包括:根據第一線段的長度、第二線段的長度以及所述第一線段與所述第二線段之間的夾角,計算第三線段的長度,作為所述目標前路的曲率半徑;其中,所述第三線段的兩個端點分別為所述目標前路的曲率中心和所述目標前路的中點,所述目標前路的曲率中心為第一垂線和第二垂線的交點,所述第一垂線垂直于第四線段且經過所述第四線段的中點,所述第二垂線垂直于第五線段且經過所述第五線段的中點,所述第一線段的兩個端點分別為所述第四線段的中點和所述目標前路的中點,所述第二線段的兩個端點分別為所述第五線段的中點和所述目標前路的中點,所述第四線段的兩個端點分別為所述目標路徑點和所述目標前路的中點,所述第五線段的兩個端點分別為所述目標前路的終點和所述目標前路的中點。如圖4所示的示例,若A表示目標路徑點、C表示目標終點,則路徑AC即為目標前路。B為路徑AC的中點,D為AB的中點,E為BC的中點,過D點AB的垂線和過E點BC的垂線交點為O,則O為目標前路的曲率中心,DO為第一垂線,EO為第二垂線,BD為第一線段,BE為第二線段,AB為第四線段,BC為第五線段,α為AB和BC之間的夾角,即所述第一線段與所述第二線段之間的夾角。通過第一線段BD的長度、第二線段BE的長度以及所述第一線段BD與所述第二線段BE之間的夾角α可以計算出第三線段BO的長度,第三線段BO的長度即是目標前路的曲率半徑。其中,用于計算第三線段BO的方程組包括:α12=α,BD/2cosα1=BE/2cosα2=BO。其中,α1為AB和BO之間的夾角,α2為BC和BO之間的夾角。

            其中,第一線段的長度具體為第四線段的長度的一半,第四線段的長度可以基于目標路徑點的經緯度信息以及目標前路的中點的經緯度信息確定;第二線段的長度具體為第五線段的長度的一半,第五線段的長度可以基于目標前路的終點的經緯度信息以及目標前路的中點的經緯度信息確定。例如,在圖4所示的示例中,BD的長度為AB長度的一半,BE的長度為BC長度的一半,AB的長度可以基于A和B的經緯度信息確定,BC的長度可以基于B和C的經緯度信息確定。

            又如,對于規劃路路徑上的所述參考路徑點來說,本實施例在S202之前例如還可以包括:根據第六線段的長度、第七線段的長度以及所述第六線段與所述第七線段之間的夾角,計算第八線段的長度,作為所述參考前路的曲率半徑;其中,所述第八線段的兩個端點分別為所述參考前路的曲率中心和所述參考前路的中點,所述參考前路的曲率中心為第三垂線和第四垂線的交點,所述第三垂線垂直于第九線段且經過所述第九線段的中點,所述第四垂線垂直于第十線段且經過所述第十線段的中點,所述第六線段的兩個端點分別為所述第九線段的中點和所述參考前路的中點,所述第七線段的兩個端點分別為所述第十線段的中點和所述參考前路的中點,所述第九線段的兩個端點分別為所述參考路徑點和所述參考前路的中點,所述第十線段的兩個端點分別為所述參考前路的終點和所述參考前路的中點。如圖4所示的示例,若A為參考路徑點、C為參考終點,路徑AC即為參考前路,B為路徑AC的中點,D為AB的中點,E為BC的中點,過D點AB的垂線和過E點BC的垂線交點為O,則O為參考前路的曲率中心,DO為第六垂線,EO為第七垂線,BD為第六線段,BE為第七線段,AB為第九線段,BC為第十線段,α為AB和BC之間的夾角,即所述第六線段與所述第七線段之間的夾角。通過第六線段BD的長度、第七線段BE的長度以及所述第六線段BD與所述第七線段BE之間的夾角α可以計算出第八線段BO的長度,第八線段BO的長度即是參考前路的曲率半徑。其中,用于計算第八線段BO的方程組包括:α12=α,BD/2cosα1=BE/2cosα2=BO,其中,α1為AB和BO之間的夾角,α2為BC和BO之間的夾角。

            可以理解的是,對于規劃路徑上的任意一個路徑點來說,在該路徑點的前路的曲率半徑確定之后,可以根據該路徑點的前路的曲率半徑以及預設的側向加速度閾值確定該路徑點處的初始規劃速度。其中,所確定出的初始規劃速度需要保證車輛在該路徑點處以所述初始規劃速度行駛的情況下受到的側向加速度不會超過所述側向加速度閾值。由于車輛在行駛過程中受到的側向加速度近似等于車輛行駛速度的平方與曲率半徑的比值(即Vx2/Radius,其中,Vx為車輛形式速度,Radius為曲率半徑),因此,在本實施例的一些實施方式中,該路徑點的初始規劃速度例如可以通過以下公式來計算:

            其中,v表示該路徑點的初始規劃速度,ay表示側向加速度閾值,radius表示該路徑點的前路的曲率半徑。例如,對于規劃路徑上的所述目標路徑點來說,v可以表示目標路徑點的初始規劃速度,radius可以表示目標前路的曲率半徑。又如,對于規劃路徑上的所述參考路徑點來說,v可以表示參考路徑點的初始規劃速度,radius可以表示參考前路的曲率半徑。

            步驟203:根據所述目標路徑點的初始規劃速度、所述參考路徑點的初始規劃速度和參考路程,確定所述目標路徑點處的目標縱向加速度和目標規劃速度,以使得所述目標縱向加速度在縱向加速度限定范圍以內,其中,所述參考路程表示在所述規劃路徑上從所述目標路徑點到所述參考路徑點的路程,所述目標縱向加速度表示在所述參考路程上由所述目標規劃速度變速成所述參考路徑點處的初始規劃速度所需的加速度。

            可以理解的是,在規劃路徑上各個路徑點處的初始規劃路徑都被確定之后,可以通過對各個路徑點上的縱向加速度進行約束,進一步對各路徑點處的初始規劃速度進行調整,從而得到各個路徑點處的目標規劃速度和目標縱向加速度。這樣可以避免路徑點上的縱向加速度過大而導致的車速過快,從而提高車輛行駛過程的安全程度以及乘坐舒適程度。其中,考慮到車輛安全性及乘坐舒適性主要是要求車輛減速時的加速度不能過大,因此,所述縱向加速度限定范圍可以包括加速運動的加速度以及不超過一定閾值的減速運動的加速度。在目標縱向加速度的數值在所述縱向加速度限定范圍以內的情況下,車輛就不會在減速時處于較大的加速度。當然,所述縱向加速度限定范圍也可以包括不超過一定閾值的加速運動的加速度,此時,若目標縱向加速度的數值在所述縱向加速度限定范圍以內,車輛就不會在加速時處于較大的加速度。

            具體實現時,對于規劃路徑上的所述目標路徑點來說,可以先基于目標路徑點在規劃路徑上選取一個參考路徑點,再基于參考路徑點的初始規劃速度、預設的縱向加速度限定范圍和在規劃路徑上目標路徑點與參考路徑點之間的參考路程對目標路徑點的初始規劃速度進行調整,從而得到目標路徑點處的目標規劃速度和目標縱向加速度。其中,所述參考路徑點是位于所述目標路徑點的航向前方的路徑點。

            在本實施例的一些實施方式中,參考路徑點可以基于預設時間閾值進行選取。具體地,以所述參考路程表示在所述規劃路徑上從所述目標路徑點到所述參考路徑點經過的路程,則所述參考路程例如可以等于所述目標路徑點的初始規劃速度與預設時間閾值的乘積。也即,為目標路徑點選取參考路徑點,具體可以在于,根據所述目標路徑點處的初始規劃速度和預設時間閾值計算所述目標路徑點處的參考路程,在所述規劃路徑上查找以所述目標路徑點為起點經過所述參考路徑所達到的終點,作為所述參考路徑點。其中,預設時間閾值可以基于駕駛員反應時間的經驗值確定。

            需要說明的是,對目標路徑點處的初始規劃速度進行調整,其調整的目的可以在于,使得車輛在規劃路徑上的目標路徑點處采用的目標縱向加速度在預設的縱向加速度限定范圍以內,從而保證車輛行駛的安全性以及乘坐舒適性。而目標路徑點處采用的目標縱向加速度可以被認為是在規劃路徑上從目標路徑點到參考路徑點的車輛行駛過程采用的縱向加速度,其中,目標路徑點處的車輛行駛速度可以被認為是目標路徑點處的目標規劃速度,參考路徑點處的車輛行駛速度可以被認為是參考路徑點處的初始規劃速度。為了實現上述調整的目的,在本實施例的一些實施方式中,可以在驗證目標路徑點處的初始規劃速度不能滿足上述調整的目的的情況下再為目標路徑點重新確定目標規劃速度。具體地,所述步驟203例如可以包括:根據所述目標路徑點的初始規劃速度、所述參考路徑點的初始規劃速度和參考路程,計算初始縱向加速度,其中,所述初始縱向加速度表示在所述參考路程上由所述目標路徑點處的初始規劃速度變速成所述參考路徑點處的初始規劃速度所需的加速度;若所述目標路徑點處的初始縱向加速度表示減速運動且所述目標路徑點處的初始縱向加速度的絕對值未超過縱向加速度閾值,或者,若所述目標路徑點處的初始加速度不表示減速運動,將所述目標路徑點處的初始縱向加速度確定為所述目標縱向加速度,則將所述目標路徑點處的初始規劃速度確定為所述目標規劃速度;若所述目標路徑點處的初始縱向加速度表示減速運動且所述目標路徑點處的初始縱向加速度的絕對值超過所述縱向加速度閾值,則減小所述目標路徑點處的初始規劃速度,返回執行所述計算初始縱向加速度的步驟。

            其中,所述初始縱向加速度例如可以通過以下公式進行計算:

            其中,a表示所述初始縱向加速度,Vt+m表示所述參考路徑點處的初始規劃速度,Vt表示所述目標路徑點處的初始規劃速度,S表示所述參考路程。

            此外,在所述目標路徑點處的初始縱向加速度表示減速運動且所述目標路徑點處的初始縱向加速度的絕對值超過所述縱向加速度閾值的情況下,也可以按照下述公式直接計算出所述目標路徑點處的目標規劃速度:

            其中,ax表示所述縱向加速度閾值,Vt+m表示所述參考路徑點處的初始規劃速度,Vt’表示所述目標路徑點處的目標規劃速度,S表示所述參考路程。此時,所述目標路徑點處的目標縱向加速度即為所述縱向加速度閾值。

            當然,除了在目標路徑點處針對減速運動的縱向加速度進行規劃車速的控制之外,也可以在目標路徑點處針對加速運動的縱向加速度進行規劃車速的控制。具體地,在根據目標路徑點與參考路徑點兩處的初始規劃速度計算出目標路徑點處的初始縱向加速度之后,若所述目標路徑點處的初始縱向加速度表示加速運動且所述目標路徑點處的初始縱向加速度的絕對值未超過縱向加速度閾值,或者,若所述目標路徑點處的初始加速度不表示加速運動,則將所述目標路徑點處的初始縱向加速度確定為所述目標縱向加速度,將所述目標路徑點處的初始規劃速度確定為所述目標規劃速度;若所述目標路徑點處的初始縱向加速度表示加速運動且所述目標路徑點處的初始縱向加速度的絕對值超過所述縱向加速度閾值,調整所述目標路徑點處的初始規劃速度,返回執行所述計算初始縱向加速度的步驟。

            此外,在目標路徑點處可以同時針對加速運動和減速運動的縱向加速度進行規劃車速的控制。具體地,在根據目標路徑點與參考路徑點兩處的初始規劃速度計算出目標路徑點處的初始縱向加速度之后,若所述目標路徑點處的初始縱向加速度的絕對值未超過縱向加速度閾值,將所述目標路徑點處的初始縱向加速度確定為所述目標縱向加速度,將所述目標路徑點處的初始規劃速度確定為所述目標規劃速度;若所述目標路徑點處的初始縱向加速度的絕對值超過縱向加速度閾值,則無論該初始縱向加速度表示加速運動還是表示減速運動都對目標路徑點處的初始規劃速度進行調整,調整之后再返回執行計算初始縱向加速度的步驟。

            需要說明的是,步驟203確定的所述目標路徑點處的目標縱向加速度和目標規劃速度可以對應所述目標路徑點進行存儲,以便在車輛行駛到所述目標路徑點時可以依據對應所述目標路徑點存儲的所述目標縱向加速度和所述目標規劃速度進行車速控制。可見,在本實施例的一些實施方式中,在步驟203之后,例如還可以包括:將所述目標規劃速度和所述目標縱向加速度保存到所述目標路徑點對應的規劃信息中,其中,所述目標路徑點的規劃信息中還包括所述目標路徑點的經緯度信息。

            可以理解的是,在車輛行駛的過程中,所述規劃路徑上路徑點的處行駛方向、曲率半徑也可以用于對車輛行駛進行控制。為此,在本實施例的一些實施方式中,在所述目標路徑點對應的規劃信息中,除了包括所述目標路徑點的經緯度信息、所述目標路徑點處的目標規劃速度和所述目標路徑點處的目標縱向加速度,例如還可以包括所述目標路徑點處的規劃航向和/或所述目標路徑點處的曲率半徑,所述目標路徑點處的規劃航向表示在所述目標路徑點處的行駛方向,所述目標路徑點處的曲率半徑為所述目標前路的曲率半徑。

            需要說明的是,在車輛實際行駛過程中,可以根據車輛當前的位置信息從已保存的各個路徑點對應的規劃信息中匹配出相應的目標路徑點的規劃信息,從而根據規劃信息實現對車輛在當前的位置的車速進行控制。具體地,在本實施例的一些實施方式中,在保存了所述目標路徑點對應的規劃信息之后,例如還可以包括:在車輛行駛過程中獲取當前行駛位置的經緯度信息;從所述目標路徑點對應的規劃信息中提取所述目標路徑點的經緯度信息;若所述當前行駛位置的經緯度信息與所述目標路徑點的經緯度信息相匹配,從所述目標路徑點對應的規劃信息中提取所述目標規劃速度和所述目標縱向加速度并依據所述目標規劃速度和所述目標縱向加速度對車速進行控制。例如,如圖5所示,在車輛行駛過程中,結合導航設備中全球定位提供的位置信息,確定車輛實際運行所處的當前位置的經緯度,根據所述經緯度得到相應的目標路徑點的規劃信息中的目標規劃速度和目標縱向加速度,通過驅動系統實現加速,發動機/電機倒拖實現輕微制動,通過主動制動實現制動,實現適應性巡航控制。

            可以理解的是,在實際進行車速控制時,所述目標路徑點處的目標規劃速度和目標縱向加速度例如可以分別作為車輛在所述目標路徑點處行駛的最大縱向速度和最大縱向加速度使用。此外,在本實施例中,所提及的“側向”表示的是與車輛行駛方向相垂直的方向,所提及的“縱向”表示的是車輛行駛方向。

            通過本實施例提供的各種實施方式,對于規劃路徑上的目標路徑點來說,用于在該目標路徑點處控制車速的目標規劃速度和目標縱向加速度是根據規劃路徑本身以及側向加速度閾值、縱向加速度限定范圍來確定的,可見,一方面,規劃路徑通過導航設備可以得到,導航設備并不像雷達、相機等探測設備那樣需要在一定的車速下才能使用,因此,車速的規劃可以適用于更廣泛的速度范圍,另一方面,在為目標路徑點規劃車速時以側向加速度閾值對目標路徑點處的側向加速度進行限制并以縱向加速度限定范圍對目標路徑點處的目標縱向加速度進行了限制,這使得在目標路徑點處按照目標規劃速度和目標縱向加速度控制行駛的車輛能夠避免劇烈的減速以及劇烈的側向偏移,從而不僅提高了車輛的行駛安全,而且還提高了車內乘客的乘坐舒適程度,并且還節省了能源。

            參見圖6,示出了本發明實施例中一種車速規劃的方法的流程示意圖。在本實施例中,所述方法例如具體可以包括如下步驟:

            步驟601:根據輸入的行駛起點和行駛終點,確定車輛行駛的規劃路徑。

            步驟602:在所述規劃路徑上確定各個路徑點處的初始規劃速度,以使得所述各個路徑點處的側向加速度不大于側向加速度閾值,其中,所述各個路徑點處的側向加速度為以所述各個路徑點處的初始規劃速度行駛而產生的側向加速度。

            所述各個路徑點處的初始規劃速度的確定方式可以參見上述實施例,在此不再贅述。

            步驟603:通過對所述各個路徑點處的初始規劃速度進行調整,確定所述各個路徑點處的目標規劃速度和目標縱向加速度,以使得所述各個路徑點處的目標縱向加速度在縱向加速度限定范圍以內。

            所述各個路徑點處的目標規劃速度和目標縱向加速度的確定方式可以參見上述實施例,在此不再贅述。

            步驟604:生成規劃信息,所述規劃信息包括所述各個路徑點處的目標規劃速度、目標縱向加速度和經緯度信息。

            可選的,在本實施例中,所述規劃信息例如還可以包括所述各個路徑點處的規劃航向和/或曲率半徑。

            步驟605:在車輛行駛過程中,通過行駛位置的經緯度信息與所述規劃信息匹配得到的所述目標規劃速度和所述目標縱向加速度,對車速進行控制。

            通過本實施例提供的各種實施方式,對于規劃路徑上的各個路徑點來說,用于在該目標路徑點處控制車速的各個路徑點規劃速度和各個路徑點縱向加速度是根據規劃路徑本身以及側向加速度閾值、縱向加速度限定范圍來確定的,可見,一方面,規劃路徑通過導航設備可以得到,導航設備并不像雷達、相機等探測設備那樣需要在一定的車速下才能使用,因此,車速的規劃可以適用于更廣泛的速度范圍,另一方面,在為各個路徑點規劃車速時以側向加速度閾值對各個路徑點處的側向加速度進行限制并以縱向加速度限定范圍對各個路徑點處的縱向加速度進行了限制,這使得在各個路徑點處按照規劃速度和規劃縱向加速度控制行駛的車輛能夠避免劇烈的減速以及劇烈的側向偏移,從而不僅提高了車輛的行駛安全,而且還提高了車內乘客的乘坐舒適程度,并且還節省了能源。

            參見圖7,示出了本發明實施例中一種車速規劃的裝置的結構示意圖。在本實施例中,所述裝置例如可以包括:

            第一確定單元701,用于根據目標前路的曲率半徑,確定所述目標路徑點處的初始規劃速度,以使得第一側向加速度不大于側向加速度閾值,其中,所述目標前路為規劃路徑上以所述目標路徑點為起點的一段路徑,所述第一側向加速度為在所述目標前路上以所述目標路徑點處的初始規劃速度行駛而產生的側向加速度;

            第二確定單元702,用于根據參考前路的曲率半徑,確定所述參考路徑點處的初始規劃速度,以使得第二側向加速度不大于所述側向加速度閾值,其中,所述參考前路為所述規劃路徑上以所述參考路徑點為起點的一段路徑,所述第二側向加速度為在所述參考前路上以所述參考路徑點處的初始規劃速度行駛而產生的側向加速度;

            第三確定單元703,用于根據所述目標路徑點的初始規劃速度、所述參考路徑點的初始規劃速度和參考路程,確定所述目標路徑點處的目標縱向加速度和目標規劃速度,以使得所述目標縱向加速度在縱向加速度限定范圍以內,其中,所述參考路程表示在所述規劃路徑上從所述目標路徑點到所述參考路徑點的路程,所述目標縱向加速度表示在所述參考路程上由所述目標規劃速度變速成所述參考路徑點處的初始規劃速度所需的加速度。

            可選的,目標終點為在所述規劃路徑上距離所述目標路徑點路程最近的第一初始終點,所述目標終點為所述目標前路的終點,所述第一初始終點與所述目標路徑點的直線距離等于預設距離閾值;參考終點為在所述規劃路徑上距離所述參考路徑點路程最近的第二初始終點,所述參考終點為所述參考前路的終點,所述第二初始終點與所述參考路徑點的直線距離等于所述預設距離閾值。

            可選的,所述裝置例如還可以包括:

            第一計算單元,用于根據第一線段的長度、第二線段的長度以及所述第一線段與所述第二線段之間的夾角,計算第三線段的長度,作為所述目標前路的曲率半徑;其中,所述第三線段的兩個端點分別為所述目標前路的曲率中心和所述目標前路的中點,所述目標前路的曲率中心為第一垂線和第二垂線的交點,所述第一垂線垂直于第四線段且經過所述第四線段的中點,所述第二垂線垂直于第五線段且經過所述第五線段的中點,所述第一線段的兩個端點分別為所述第四線段的中點和所述目標前路的中點,所述第二線段的兩個端點分別為所述第五線段的中點和所述目標前路的中點,所述第四線段的兩個端點分別為所述目標路徑點和所述目標前路的中點,所述第五線段的兩個端點分別為所述目標前路的終點和所述目標前路的中點;

            第二計算單元,用于根據第六線段的長度、第七線段的長度以及所述第六線段與所述第七線段之間的夾角,計算第八線段的長度,作為所述參考前路的曲率半徑;其中,所述第八線段的兩個端點分別為所述參考前路的曲率中心和所述參考前路的中點,所述參考前路的曲率中心為第三垂線和第四垂線的交點,所述第三垂線垂直于第九線段且經過所述第九線段的中點,所述第四垂線垂直于第十線段且經過所述第十線段的中點,所述第六線段的兩個端點分別為所述第九線段的中點和所述參考前路的中點,所述第七線段的兩個端點分別為所述第十線段的中點和所述參考前路的中點,所述第九線段的兩個端點分別為所述參考路徑點和所述參考前路的中點,所述第十線段的兩個端點分別為所述參考前路的終點和所述參考前路的中點。

            可選的,所述參考路程等于所述目標路徑點的初始規劃速度與預設時間閾值的乘積。

            可選的,所述第三確定單元703,例如可以包括:

            計算子單元,用于根據所述目標路徑點的初始規劃速度、所述參考路徑點的初始規劃速度和參考路程,計算初始縱向加速度,其中,所述初始縱向加速度表示在所述參考路程上由所述目標路徑點處的初始規劃速度變速成所述參考路徑點處的初始規劃速度所需的加速度;

            確定子單元,用于若所述目標路徑點處的初始縱向加速度表示減速運動且所述目標路徑點處的初始縱向加速度的絕對值未超過縱向加速度閾值,或者,若所述目標路徑點處的初始縱向加速度不表示減速運動,則將所述目標路徑點處的初始縱向加速度確定為所述目標縱向加速度,將所述目標路徑點處的初始規劃速度確定為所述目標規劃速度;

            減速子單元,用于若所述目標路徑點處的初始縱向加速度表示減速運動且所述目標路徑點處的初始縱向加速度的絕對值超過所述縱向加速度閾值,則減小所述目標路徑點處的初始規劃速度,并觸發所述計算子單元。

            可選的,所述裝置例如還可以包括:

            保存單元,用于將所述目標規劃速度和所述目標縱向加速度保存到所述目標路徑點對應的規劃信息中,其中,所述目標路徑點的規劃信息中還包括所述目標路徑點的經緯度信息。

            可選的,所述目標路徑點對應的規劃信息例如還可以包括:所述目標路徑點處的規劃航向和/或所述目標路徑點處的曲率半徑,所述目標路徑點處的規劃航向表示在所述目標路徑點處的行駛方向,所述目標路徑點處的曲率半徑為所述目標前路的曲率半徑。

            可選的,所述裝置例如還可以包括:

            獲取單元,用于在車輛行駛過程中獲取當前行駛位置的經緯度信息;

            提取單元,用于從所述目標路徑點對應的規劃信息中提取所述目標路徑點的經緯度信息;

            車速控制單元,用于若所述當前行駛位置的經緯度信息與所述目標路徑點的經緯度信息相匹配,從所述目標路徑點對應的規劃信息中提取所述目標規劃速度和所述目標縱向加速度并依據所述目標規劃速度和所述目標縱向加速度對車速進行控制。

            通過本實施例提供的各種實施方式,對于規劃路徑上的目標路徑點來說,用于在該目標路徑點處控制車速的目標規劃速度和目標縱向加速度是根據規劃路徑本身以及側向加速度閾值、縱向加速度限定范圍來確定的,可見,一方面,規劃路徑通過導航設備可以得到,導航設備并不像雷達、相機等探測設備那樣需要在一定的車速下才能使用,因此,車速的規劃可以適用于更廣泛的速度范圍,另一方面,在為目標路徑點規劃車速時以側向加速度閾值對目標路徑點處的側向加速度進行限制并以縱向加速度限定范圍對目標路徑點處的目標縱向加速度進行了限制,這使得在目標路徑點處按照目標規劃速度和目標縱向加速度控制行駛的車輛能夠避免劇烈的減速以及劇烈的側向偏移,從而不僅提高了車輛的行駛安全,而且還提高了車內乘客的乘坐舒適程度,并且還節省了能源。

            參見圖8,示出了本發明實施例中一種車速規劃的設備的結構示意圖。在本實施例中,所述設備800例如可以包括處理器801、存儲器802、通信接口803、總線系統804。其中,

            所述總線系統804,用于將所述設備的各個硬件組件耦合在一起;

            所述通信接口803,用于實現所述設備與至少一個其它設備之間的通信連接;

            所述存儲器802,用于存儲程序指令和數據;

            所述處理器801,用于讀取存儲器802中存儲的指令和數據,執行以下操作:

            根據目標前路的曲率半徑,確定所述目標路徑點處的初始規劃速度,以使得第一側向加速度不大于側向加速度閾值,其中,所述目標前路為規劃路徑上以所述目標路徑點為起點的一段路徑,所述第一側向加速度為在所述目標前路上以所述目標路徑點處的初始規劃速度行駛而產生的側向加速度;

            根據參考前路的曲率半徑,確定所述參考路徑點處的初始規劃速度,以使得第二側向加速度不大于所述側向加速度閾值,其中,所述參考前路為所述規劃路徑上以所述參考路徑點為起點的一段路徑,所述第二側向加速度為在所述參考前路上以所述參考路徑點處的初始規劃速度行駛而產生的側向加速度;

            根據所述目標路徑點的初始規劃速度、所述參考路徑點的初始規劃速度和參考路程,確定所述目標路徑點處的目標縱向加速度和目標規劃速度,以使得所述目標縱向加速度在縱向加速度限定范圍以內,其中,所述參考路程表示在所述規劃路徑上從所述目標路徑點到所述參考路徑點的路程,所述目標縱向加速度表示在所述參考路程上由所述目標規劃速度變速成所述參考路徑點處的初始規劃速度所需的加速度。

            可選的,目標終點為在所述規劃路徑上距離所述目標路徑點路程最近的第一初始終點,所述目標終點為所述目標前路的終點,所述第一初始終點與所述目標路徑點的直線距離等于預設距離閾值;參考終點為在所述規劃路徑上距離所述參考路徑點路程最近的第二初始終點,所述參考終點為所述參考前路的終點,所述第二初始終點與所述參考路徑點的直線距離等于所述預設距離閾值。

            可選的,所述處理器801例如還可以執行以下操作:

            根據第一線段的長度、第二線段的長度以及所述第一線段與所述第二線段之間的夾角,計算第三線段的長度,作為所述目標前路的曲率半徑;其中,所述第三線段的兩個端點分別為所述目標前路的曲率中心和所述目標前路的中點,所述目標前路的曲率中心為第一垂線和第二垂線的交點,所述第一垂線垂直于第四線段且經過所述第四線段的中點,所述第二垂線垂直于第五線段且經過所述第五線段的中點,所述第一線段的兩個端點分別為所述第四線段的中點和所述目標前路的中點,所述第二線段的兩個端點分別為所述第五線段的中點和所述目標前路的中點,所述第四線段的兩個端點分別為所述目標路徑點和所述目標前路的中點,所述第五線段的兩個端點分別為所述目標前路的終點和所述目標前路的中點;

            根據第六線段的長度、第七線段的長度以及所述第六線段與所述第七線段之間的夾角,計算第八線段的長度,作為所述參考前路的曲率半徑;其中,所述第八線段的兩個端點分別為所述參考前路的曲率中心和所述參考前路的中點,所述參考前路的曲率中心為第三垂線和第四垂線的交點,所述第三垂線垂直于第九線段且經過所述第九線段的中點,所述第四垂線垂直于第十線段且經過所述第十線段的中點,所述第六線段的兩個端點分別為所述第九線段的中點和所述參考前路的中點,所述第七線段的兩個端點分別為所述第十線段的中點和所述參考前路的中點,所述第九線段的兩個端點分別為所述參考路徑點和所述參考前路的中點,所述第十線段的兩個端點分別為所述參考前路的終點和所述參考前路的中點。

            可選的,所述參考路程等于所述目標路徑點的初始規劃速度與預設時間閾值的乘積。

            可選的,為了確定所述目標路徑點處的目標縱向加速度和目標規劃速度,所述處理器801可以執行以下操作:

            根據所述目標路徑點的初始規劃速度、所述參考路徑點的初始規劃速度和參考路程,計算初始縱向加速度,其中,所述初始縱向加速度表示在所述參考路程上由所述目標路徑點處的初始規劃速度變速成所述參考路徑點處的初始規劃速度所需的加速度;

            若所述目標路徑點處的初始縱向加速度表示減速運動且所述目標路徑點處的初始縱向加速度的絕對值未超過縱向加速度閾值,或者,若所述目標路徑點處的初始縱向加速度不表示減速運動,則將所述目標路徑點處的初始縱向加速度確定為所述目標縱向加速度,將所述目標路徑點處的初始規劃速度確定為所述目標規劃速度;

            若所述目標路徑點處的初始縱向加速度表示減速運動且所述目標路徑點處的初始縱向加速度的絕對值超過所述縱向加速度閾值,則減小所述目標路徑點處的初始規劃速度,返回執行所述計算初始縱向加速度的步驟。

            可選的,所述處理器801例如還可以執行以下操作:

            將所述目標規劃速度和所述目標縱向加速度保存到所述目標路徑點對應的規劃信息中,其中,所述目標路徑點的規劃信息中還包括所述目標路徑點的經緯度信息。

            其中,所述目標路徑點對應的規劃信息還包括所述目標路徑點處的規劃航向和/或所述目標路徑點處的曲率半徑,所述目標路徑點處的規劃航向表示在所述目標路徑點處的行駛方向,所述目標路徑點處的曲率半徑為所述目標前路的曲率半徑。

            可選的,所述處理器801例如還可以執行以下操作:

            在車輛行駛過程中獲取當前行駛位置的經緯度信息;

            從所述目標路徑點對應的規劃信息中提取所述目標路徑點的經緯度信息;

            若所述當前行駛位置的經緯度信息與所述目標路徑點的經緯度信息相匹配,從所述目標路徑點對應的規劃信息中提取所述目標規劃速度和所述目標縱向加速度并依據所述目標規劃速度和所述目標縱向加速度對車速進行控制。

            通過本實施例提供的各種實施方式,對于規劃路徑上的目標路徑點來說,用于在該目標路徑點處控制車速的目標規劃速度和目標縱向加速度是根據規劃路徑本身以及側向加速度閾值、縱向加速度限定范圍來確定的,可見,一方面,規劃路徑通過導航設備可以得到,導航設備并不像雷達、相機等探測設備那樣需要在一定的車速下才能使用,因此,車速的規劃可以適用于更廣泛的速度范圍,另一方面,在為目標路徑點規劃車速時以側向加速度閾值對目標路徑點處的側向加速度進行限制并以縱向加速度限定范圍對目標路徑點處的目標縱向加速度進行了限制,這使得在目標路徑點處按照目標規劃速度和目標縱向加速度控制行駛的車輛能夠避免劇烈的減速以及劇烈的側向偏移,從而不僅提高了車輛的行駛安全,而且還提高了車內乘客的乘坐舒適程度,并且還節省了能源。

            本發明實施例中提到的“第一初始終點”、“第一線段”、“第一確定單元”等名稱中的“第一”只是用來做名字標識,并不代表順序上的第一。該規則同樣適用于“第二”、“第三”等。

            通過以上的實施方式的描述可知,本領域的技術人員可以清楚地了解到上述實施例方法中的全部或部分步驟可借助軟件加通用硬件平臺的方式來實現。基于這樣的理解,本發明的技術方案可以以軟件產品的形式體現出來,該計算機軟件產品可以存儲在存儲介質中,如只讀存儲器(英文:read-only memory,ROM)/RAM、磁碟、光盤等,包括若干指令用以使得一臺計算機設備(可以是個人計算機,服務器,或者諸如路由器等網絡通信設備)執行本發明各個實施例或者實施例的某些部分所述的方法。

            本說明書中的各個實施例均采用遞進的方式描述,各個實施例之間相同相似的部分互相參見即可,每個實施例重點說明的都是與其他實施例的不同之處。尤其,對于方法實施例和設備實施例而言,由于其基本相似于系統實施例,所以描述得比較簡單,相關之處參見系統實施例的部分說明即可。以上所描述的設備及系統實施例僅僅是示意性的,其中作為分離部件說明的模塊可以是或者也可以不是物理上分開的,作為模塊顯示的部件可以是或者也可以不是物理模塊,即可以位于一個地方,或者也可以分布到多個網絡單元上。可以根據實際的需要選擇其中的部分或者全部模塊來實現本實施例方案的目的。本領域普通技術人員在不付出創造性勞動的情況下,即可以理解并實施。

            以上所述僅是本發明的優選實施方式,并非用于限定本發明的保護范圍。應當指出,對于本技術領域的普通技術人員來說,在不脫離本發明的前提下,還可以做出若干改進和潤飾,這些改進和潤飾也應視為本發明的保護范圍。

            當前第1頁1 2 3 
            網友詢問留言 已有0條留言
            • 還沒有人留言評論。精彩留言會獲得點贊!
            1
            婷婷六月激情在线综合激情,亚洲国产大片,久久中文字幕综合婷婷,精品久久久久久中文字幕,亚洲一区二区三区高清不卡,99国产精品热久久久久久夜夜嗨 ,欧美日韩亚洲综合在线一区二区,99国产精品电影,伊人精品线视天天综合,精品伊人久久久大香线蕉欧美
            亚洲精品1区 国产成人一级 91精品国产欧美一区二区 亚洲精品乱码久久久久久下载 国产精品久久久久久久伊一 九色国产 国产精品九九视频 伊人久久成人爱综合网 欧美日韩亚洲区久久综合 欧美日本一道免费一区三区 夜夜爽一区二区三区精品 欧美日韩高清一区二区三区 国产成人av在线 国产精品对白交换绿帽视频 国产视频亚洲 国产在线欧美精品 国产精品综合网 国产日韩精品欧美一区色 国产日韩精品欧美一区喷 欧美日韩在线观看区一二 国产区精品 欧美视频日韩视频 中文字幕天天躁日日躁狠狠躁97 视频一二三区 欧美高清在线精品一区二区不卡 国产精品揄拍一区二区久久 99久久综合狠狠综合久久aⅴ 亚洲乱码视频在线观看 日韩在线第二页 亚洲精品无码专区在线播放 成人亚洲网站www在线观看 欧美三级一区二区 99久久精品免费看国产高清 91麻豆国产在线观看 最新日韩欧美不卡一二三区 成人在线观看不卡 日韩国产在线 在线亚洲精品 亚洲午夜久久久久中文字幕 国产精品成人久久久久久久 精品国产一区二区在线观看 欧美精品国产一区二区三区 中文在线播放 亚洲第一页在线视频 国产午夜精品福利久久 九色国产 精品国产九九 国产永久视频 久久精品人人做人人综合试看 国产一区二区三区免费观看 亚洲精品国产电影 9999热视频 国产精品资源在线 麻豆久久婷婷国产综合五月 国产精品免费一级在线观看 亚洲国产一区二区三区青草影视 中文在线播放 国产成人综合在线 国产在线观看色 国产亚洲三级 国产片一区二区三区 久久99精品久久久久久牛牛影视 亚洲欧美日韩国产 四虎永久免费网站 国产一毛片 国产精品视频在 九九热在线精品 99精品福利视频 色婷婷色99国产综合精品 97成人精品视频在线播放 精品久久久久久中文字幕 亚洲欧美一区二区三区孕妇 亚洲欧美成人网 日韩高清在线二区 国产尤物在线观看 在线不卡一区二区 91网站在线看 韩国精品福利一区二区 欧美日韩国产成人精品 99热精品久久 国产精品免费视频一区 高清视频一区 精品九九久久 欧美日韩在线观看免费 91欧美激情一区二区三区成人 99福利视频 亚洲国产精品91 久热国产在线 精品久久久久久中文字幕女 国产精品久久久久久久久99热 成人自拍视频网 国产精品视频久久久久久 久久影院国产 国产玖玖在线观看 99精品在线免费 亚洲欧美一区二区三区导航 久久久久久久综合 国产欧美日韩精品高清二区综合区 国产精品视频自拍 亚洲一级片免费 久久久久久九九 国产欧美自拍视频 视频一区二区在线观看 欧美日韩一区二区三区久久 中文在线亚洲 伊人热人久久中文字幕 日韩欧美亚洲国产一区二区三区 欧美亚洲国产成人高清在线 欧美日韩国产码高清综合人成 国产性大片免费播放网站 亚洲午夜综合网 91精品久久一区二区三区 国产无套在线播放 国产精品视频网站 国产成人亚洲精品老王 91在线网站 国产视频97 欧美黑人欧美精品刺激 国产一区二区三区免费在线视频 久久久国产精品免费看 99re6久精品国产首页 久久精品91 国产成人一级 国产成人精品曰本亚洲 日本福利在线观看 伊人成综合网 久久综合一本 国产综合久久久久久 久久精品成人免费看 久久福利 91精品国产91久久久久久麻豆 亚洲精品成人在线 亚洲伊人久久精品 欧美日本二区 国产永久视频 国产一区二 一区二区福利 国产一毛片 亚洲精品1区 毛片一区二区三区 伊人久久大香线蕉综合影 国产欧美在线观看一区 亚洲国产欧洲综合997久久 国产一区二区免费视频 国产91精品对白露脸全集观看 久久亚洲国产伦理 欧美成人伊人久久综合网 亚洲性久久久影院 久久99国产精一区二区三区! 91精品国产欧美一区二区 欧美日韩亚洲区久久综合 日韩精品一二三区 久久久夜色精品国产噜噜 国产在线精品福利91香蕉 久久久久久久亚洲精品 97se色综合一区二区二区 91国语精品自产拍在线观看性色 91久久国产综合精品女同我 日韩中文字幕a 国产成人亚洲日本精品 久久国产精品-国产精品 久久国产经典视频 久久国产精品伦理 亚洲第一页在线视频 国产精品久久久久三级 日韩毛片网 久久免费高清视频 麻豆国产在线观看一区二区 91麻豆国产福利在线观看 国产成人精品男人的天堂538 一区二区三区中文字幕 免费在线视频一区 欧美日韩国产成人精品 国产综合网站 国产资源免费观看 亚洲精品亚洲人成在线播放 精品久久久久久中文字幕专区 亚洲人成人毛片无遮挡 国产一起色一起爱 国产香蕉精品视频在 九九热免费观看 日韩亚洲欧美一区 九九热精品在线观看 精品久久久久久中文字幕专区 亚洲欧美自拍偷拍 国产精品每日更新 久久久久国产一级毛片高清板 久久天天躁狠狠躁夜夜中文字幕 久久精品片 日韩在线毛片 国产成人精品本亚洲 国产成人精品一区二区三区 九九热在线观看 国产r级在线观看 国产欧美日韩精品高清二区综合区 韩国电影一区二区 国产精品毛片va一区二区三区 五月婷婷伊人网 久久一区二区三区免费 一本色道久久综合狠狠躁篇 亚洲综合色站 国产尤物在线观看 亚洲一区亚洲二区 免费在线视频一区 欧洲精品视频在线观看 日韩中文字幕a 中文字幕日本在线mv视频精品 91精品在线免费视频 精品国产免费人成在线观看 精品a级片 中文字幕日本在线mv视频精品 日韩在线精品视频 婷婷丁香色 91精品国产高清久久久久 国产成人精品日本亚洲直接 五月综合视频 欧美日韩在线亚洲国产人 精液呈暗黄色 亚洲乱码一区 久久精品中文字幕不卡一二区 亚洲天堂精品在线 激情婷婷综合 国产免费久久精品久久久 国产精品亚洲二区在线 久久免费播放视频 五月婷婷丁香综合 在线亚洲欧美日韩 久久免费精品高清麻豆 精品久久久久久中文字幕 亚洲一区网站 国产精品福利社 日韩中文字幕免费 亚洲综合丝袜 91精品在线播放 国产精品18 亚洲日日夜夜 伊人久久大香线蕉综合影 亚洲精品中文字幕乱码影院 亚洲一区二区黄色 亚洲第一页在线视频 一区二区在线观看视频 国产成人福利精品视频 亚洲高清二区 国内成人免费视频 精品亚洲性xxx久久久 国产精品合集一区二区三区 97av免费视频 国产一起色一起爱 国产区久久 国产资源免费观看 99精品视频免费 国产成人一级 国产精品九九免费视频 欧美91精品久久久久网免费 99热国产免费 久久精品色 98精品国产综合久久 久久精品播放 中文字幕视频免费 国产欧美日韩一区二区三区在线 精品久久蜜桃 国产小视频精品 一本色道久久综合狠狠躁篇 91在线免费观看 亚洲精品区 伊人成综合网 伊人热人久久中文字幕 伊人黄色片 99国产精品热久久久久久夜夜嗨 久久免费精品视频 亚洲一区二区三区高清不卡 久久久久国产一级毛片高清板 国产片一区二区三区 久久狠狠干 99久久婷婷国产综合精品电影 国产99区 国产精品成人久久久久 久久狠狠干 青青国产在线观看 亚洲高清国产拍精品影院 国产精品一区二区av 九九热在线免费视频 伊人久久国产 国产精品久久久久久久久久一区 在线观看免费视频一区 国产精品自在在线午夜区app 国产精品综合色区在线观看 国产毛片久久久久久国产毛片 97国产免费全部免费观看 国产精品每日更新 国产尤物视频在线 九九视频这里只有精品99 一本一道久久a久久精品综合 久久综合给会久久狠狠狠 国产成人精品男人的天堂538 欧美一区二区高清 毛片一区二区三区 国产欧美日韩在线观看一区二区三区 在线国产二区 欧美不卡网 91在线精品中文字幕 在线国产福利 国内精品91久久久久 91亚洲福利 日韩欧美国产中文字幕 91久久精品国产性色也91久久 亚洲性久久久影院 欧美精品1区 国产热re99久久6国产精品 九九热免费观看 国产精品欧美日韩 久久久久国产一级毛片高清板 久久国产经典视频 日韩欧美亚洲国产一区二区三区 欧美亚洲综合另类在线观看 国产精品自在在线午夜区app 97中文字幕在线观看 视频一二三区 精品国产一区在线观看 国产欧美日韩在线一区二区不卡 欧美一区二三区 伊人成人在线观看 国内精品91久久久久 97在线亚洲 国产在线不卡一区 久久久全免费全集一级全黄片 国产精品v欧美精品∨日韩 亚洲毛片网站 在线不卡一区二区 99re热在线视频 久久激情网 国产毛片一区二区三区精品 久久亚洲综合色 中文字幕视频免费 国产视频亚洲 婷婷伊人久久 国产一区二区免费播放 久久99国产精品成人欧美 99国产在线视频 国产成人免费视频精品一区二区 国产不卡一区二区三区免费视 国产码欧美日韩高清综合一区 久久精品国产主播一区二区 国产一区电影 久久精品国产夜色 国产精品国产三级国产 日韩一区二区三区在线 久久97久久97精品免视看 久久国产免费一区二区三区 伊人久久大香线蕉综合电影网 99re6久精品国产首页 久久激情网 亚洲成人高清在线 国产精品网址 国产成人精品男人的天堂538 香蕉国产综合久久猫咪 国产专区中文字幕 91麻豆精品国产高清在线 久久国产经典视频 国产精品成人va在线观看 国产精品爱啪在线线免费观看 日本精品久久久久久久久免费 亚洲综合一区二区三区 久久五月网 精品国产网红福利在线观看 久久综合亚洲伊人色 亚洲国产精品久久久久久网站 在线日韩国产 99国产精品热久久久久久夜夜嗨 国产综合精品在线 国产区福利 精品亚洲综合久久中文字幕 国产制服丝袜在线 毛片在线播放网站 在线观看免费视频一区 国产精品久久久精品三级 亚洲国产电影在线观看 最新日韩欧美不卡一二三区 狠狠综合久久综合鬼色 日本精品1在线区 国产日韩一区二区三区在线播放 欧美日韩精品在线播放 亚洲欧美日韩国产一区二区三区精品 久久综合久久网 婷婷六月激情在线综合激情 亚洲乱码一区 国产专区91 97av视频在线观看 精品久久久久久中文字幕 久久五月视频 国产成人福利精品视频 国产精品网址 中文字幕视频在线 精品一区二区三区免费视频 伊人手机在线视频 亚洲精品中文字幕乱码 国产在线视频www色 色噜噜国产精品视频一区二区 精品亚洲成a人在线观看 国产香蕉尹人综合在线 成人免费一区二区三区在线观看 国产不卡一区二区三区免费视 欧美精品久久天天躁 国产专区中文字幕 久久精品国产免费中文 久久精品国产免费一区 久久无码精品一区二区三区 国产欧美另类久久久精品免费 欧美精品久久天天躁 亚洲精品在线视频 国产视频91在线 91精品福利一区二区三区野战 日韩中文字幕免费 国产精品99一区二区三区 欧美成人高清性色生活 国产精品系列在线观看 亚洲国产福利精品一区二区 国产成人在线小视频 国产精品久久久久免费 99re热在线视频 久久久久久久综合 一区二区国产在线播放 成人国产在线视频 亚洲精品乱码久久久久 欧美日韩一区二区综合 精品久久久久免费极品大片 中文字幕视频二区 激情粉嫩精品国产尤物 国产成人精品一区二区视频 久久精品中文字幕首页 亚洲高清在线 国产精品亚洲一区二区三区 伊人久久艹 中文在线亚洲 国产精品一区二区在线播放 国产精品九九免费视频 亚洲二区在线播放 亚洲狠狠婷婷综合久久久久网站 亚洲欧美日韩网站 日韩成人精品 亚洲国产一区二区三区青草影视 91精品国产福利在线观看 国产精品久久久久久久久99热 国产一区二区精品尤物 久碰香蕉精品视频在线观看 亚洲日日夜夜 在线不卡一区二区 国产午夜亚洲精品 九九热在线视频观看这里只有精品 伊人手机在线视频 91免费国产精品 日韩欧美中字 91精品国产91久久久久 国产全黄三级播放 视频一区二区三区免费观看 国产开裆丝袜高跟在线观看 国产成人欧美 激情综合丝袜美女一区二区 国产成人亚洲综合无 欧美精品一区二区三区免费观看 欧美亚洲国产日韩 日韩亚州 国产欧美日韩精品高清二区综合区 亚洲午夜国产片在线观看 精品久久久久久中文字幕 欧美精品1区 久久伊人久久亚洲综合 亚洲欧美日韩精品 国产成人精品久久亚洲高清不卡 久久福利影视 国产精品99精品久久免费 久久久久免费精品视频 国产日产亚洲精品 亚洲国产午夜电影在线入口 精品无码一区在线观看 午夜国产精品视频 亚洲一级片免费 伊人久久大香线蕉综合影 国产精品久久影院 久碰香蕉精品视频在线观看 www.欧美精品 在线小视频国产 亚洲国产天堂久久综合图区 欧美一区二区三区不卡 日韩美女福利视频 九九精品免视频国产成人 不卡国产00高中生在线视频 亚洲第一页在线视频 欧美日韩在线播放成人 99re视频这里只有精品 国产精品91在线 精品乱码一区二区三区在线 国产区久久 91麻豆精品国产自产在线观看一区 日韩精品成人在线 九九热在线观看 国产精品久久不卡日韩美女 欧美一区二区三区综合色视频 欧美精品免费一区欧美久久优播 国产精品网址 国产专区中文字幕 国产精品欧美亚洲韩国日本久久 日韩美香港a一级毛片 久久精品123 欧美一区二区三区免费看 99r在线视频 亚洲精品国产字幕久久vr 国产综合激情在线亚洲第一页 91免费国产精品 日韩免费小视频 亚洲国产精品综合一区在线 国产亚洲第一伦理第一区 在线亚洲精品 国产精品一区二区制服丝袜 国产在线成人精品 九九精品免视频国产成人 亚洲国产网 欧美日韩亚洲一区二区三区在线观看 在线亚洲精品 欧美一区二区三区高清视频 国产成人精品男人的天堂538 欧美日韩在线观看区一二 亚洲欧美一区二区久久 久久精品中文字幕首页 日本高清www午夜视频 久久精品国产免费 久久999精品 亚洲国产精品欧美综合 88国产精品视频一区二区三区 91久久偷偷做嫩草影院免费看 国产精品夜色视频一区二区 欧美日韩导航 国产成人啪精品午夜在线播放 一区二区视频在线免费观看 99久久精品国产自免费 精液呈暗黄色 久久99国产精品 日本精品久久久久久久久免费 精品国产97在线观看 99re视频这里只有精品 国产视频91在线 999av视频 亚洲美女视频一区二区三区 久久97久久97精品免视看 亚洲国产成人久久三区 99久久亚洲国产高清观看 日韩毛片在线视频 综合激情在线 91福利一区二区在线观看 一区二区视频在线免费观看 激情粉嫩精品国产尤物 国产成人精品曰本亚洲78 国产成人精品本亚洲 国产精品成人免费视频 国产成人啪精品视频免费软件 久久精品国产亚洲妲己影院 国产精品成人久久久久久久 久久大香线蕉综合爱 欧美一区二区三区高清视频 99热国产免费 在线观看欧美国产 91精品视频在线播放 国产精品福利社 欧美精品一区二区三区免费观看 国产一区二区免费视频 国产午夜精品一区二区 精品视频在线观看97 91精品福利久久久 国产一区福利 国产综合激情在线亚洲第一页 国产精品久久久久久久久久久不卡 九色国产 在线日韩国产 黄网在线观看 亚洲一区小说区中文字幕 中文字幕丝袜 日本二区在线观看 日本国产一区在线观看 欧美日韩一区二区三区久久 欧美精品亚洲精品日韩专 国产日产亚洲精品 久久综合九色综合欧美播 亚洲国产欧美无圣光一区 欧美视频区 亚洲乱码视频在线观看 久久无码精品一区二区三区 九九热精品免费视频 久久99精品久久久久久牛牛影视 国产精品成久久久久三级 国产一区福利 午夜国产精品视频 日本二区在线观看 99久久网站 国产亚洲天堂 精品国产一区二区三区不卡 亚洲国产日韩在线一区 国产成人综合在线观看网站 久久免费高清视频 欧美在线导航 午夜精品久久久久久99热7777 欧美久久综合网 国产小视频精品 国产尤物在线观看 亚洲国产精品综合一区在线 欧美一区二区三区不卡视频 欧美黑人欧美精品刺激 日本福利在线观看 久久国产偷 国产手机精品一区二区 国产热re99久久6国产精品 国产高清啪啪 欧美亚洲国产成人高清在线 国产在线第三页 亚洲综合一区二区三区 99r在线视频 99精品久久久久久久婷婷 国产精品乱码免费一区二区 国产在线精品福利91香蕉 国产尤物视频在线 五月婷婷亚洲 中文字幕久久综合伊人 亚洲精品一级毛片 99国产精品电影 在线视频第一页 久久99国产精品成人欧美 国产白白视频在线观看2 成人精品一区二区www 亚洲成人网在线观看 麻豆91在线视频 色综合合久久天天综合绕视看 久久精品国产免费高清 国产不卡一区二区三区免费视 欧美国产中文 99精品欧美 九九在线精品 国产中文字幕在线免费观看 国产一区中文字幕在线观看 国产成人一级 国产精品一区二区制服丝袜 国产一起色一起爱 亚洲精品成人在线 亚洲欧美精品在线 国产欧美自拍视频 99精品久久久久久久婷婷 久99视频 国产热re99久久6国产精品 视频一区亚洲 国产精品视频分类 国产精品成在线观看 99re6久精品国产首页 亚洲在成人网在线看 亚洲国产日韩在线一区 久久国产三级 日韩国产欧美 欧美在线一区二区三区 国产精品美女一级在线观看 成人午夜免费福利视频 亚洲天堂精品在线 91精品国产手机 欧美日韩视频在线播放 狠狠综合久久综合鬼色 九一色视频 青青视频国产 亚洲欧美自拍一区 中文字幕天天躁日日躁狠狠躁97 日韩免费大片 996热视频 伊人成综合网 亚洲天堂欧美 日韩精品亚洲人成在线观看 久久综合给会久久狠狠狠 日韩精品亚洲人成在线观看 日韩国产欧美 亚洲成aⅴ人片在线影院八 亚洲精品1区 99久久精品免费 国产精品高清在线观看 国产精品久久久免费视频 在线亚洲欧美日韩 91在线看视频 国产精品96久久久久久久 欧美日韩国产成人精品 91在线亚洲 热久久亚洲 国产精品美女免费视频观看 日韩在线毛片 亚洲永久免费视频 九九免费在线视频 亚洲一区网站 日本高清二区视频久二区 精品国产美女福利在线 伊人久久艹 国产精品久久久久三级 欧美成人精品第一区二区三区 99久久精品国产自免费 在线观看日韩一区 国产中文字幕一区 成人免费午夜视频 欧美日韩另类在线 久久99国产精品成人欧美 色婷婷中文网 久久天天躁夜夜躁狠狠躁2020 欧美成人伊人久久综合网 国产精品福利资源在线 国产伦精品一区二区三区高清 国产精品亚洲综合色区韩国 亚洲一区欧美日韩 色综合视频 国语自产精品视频在线区 国产高清a 成人国内精品久久久久影 国产在线精品香蕉综合网一区 国产不卡在线看 国产成人精品精品欧美 国产欧美日韩综合精品一区二区三区 韩国电影一区二区 国产在线视频www色 91中文字幕在线一区 国产人成午夜免视频网站 亚洲综合一区二区三区 色综合视频一区二区观看 久久五月网 九九热精品在线观看 国产一区二区三区国产精品 99久热re在线精品996热视频 亚洲国产网 在线视频亚洲一区 日韩字幕一中文在线综合 国产高清一级毛片在线不卡 精品国产色在线 国产高清视频一区二区 精品日本久久久久久久久久 亚洲国产午夜精品乱码 成人免费国产gav视频在线 日韩欧美一区二区在线观看 欧美曰批人成在线观看 韩国电影一区二区 99re这里只有精品6 日韩精品一区二区三区视频 99re6久精品国产首页 亚洲欧美一区二区三区导航 欧美色图一区二区三区 午夜精品视频在线观看 欧美激情在线观看一区二区三区 亚洲热在线 成人国产精品一区二区网站 亚洲一级毛片在线播放 亚洲一区小说区中文字幕 亚洲午夜久久久久影院 国产自产v一区二区三区c 国产精品视频免费 久久调教视频 国产成人91激情在线播放 国产精品欧美亚洲韩国日本久久 久久亚洲日本不卡一区二区 91中文字幕网 成人国产在线视频 国产视频91在线 欧美成人精品第一区二区三区 国产精品福利在线 久久综合九色综合精品 欧美一区二区三区精品 久久国产综合尤物免费观看 久久99青青久久99久久 日韩精品免费 久久国产精品999 91亚洲视频在线观看 国产精品igao视频 色综合区 在线亚洲欧国产精品专区 国产一区二区三区在线观看视频 亚洲精品成人在线 一区二区国产在线播放 中文在线亚洲 亚洲精品第一国产综合野 国产一区二区精品久久 一区二区三区四区精品视频 99热精品久久 中文字幕视频二区 国产成人精品男人的天堂538 99精品影视 美女福利视频一区二区 久久午夜夜伦伦鲁鲁片 综合久久久久久久综合网 国产精品国产欧美综合一区 国产99视频在线观看 国产亚洲女在线精品 婷婷影院在线综合免费视频 国产亚洲3p一区二区三区 91成人爽a毛片一区二区 亚洲一区二区高清 国产欧美亚洲精品第二区首页 欧美日韩导航 亚洲高清二区 欧美激情观看一区二区久久 日韩毛片在线播放 亚洲欧美日韩高清中文在线 亚洲日本在线播放 国产精品一区二区制服丝袜 精品国产一区二区三区不卡 国产不卡在线看 国产欧美网站 四虎永久在线观看视频精品 国产黄色片在线观看 夜夜综合 一本色道久久综合狠狠躁篇 欧美亚洲综合另类在线观看 国产91在线看 伊人久久国产 欧美一区二区在线观看免费网站 国产精品久久久久三级 久久福利 日韩中文字幕a 亚洲午夜久久久久影院 91在线高清视频 国产亚洲一区二区三区啪 久久人精品 国产精品亚洲午夜一区二区三区 综合久久久久久 久久伊人一区二区三区四区 国产综合久久久久久 日韩一区精品视频在线看 国产精品日韩欧美制服 日本精品1在线区 99re视频 无码av免费一区二区三区试看 国产视频1区 日韩欧美中文字幕一区 日本高清中文字幕一区二区三区a 亚洲国产欧美无圣光一区 国产在线视频一区二区三区 欧美国产第一页 在线亚洲欧美日韩 日韩中文字幕第一页 在线不卡一区二区 伊人久久青青 国产精品一区二区在线播放 www.五月婷婷 麻豆久久婷婷国产综合五月 亚洲精品区 久久国产欧美另类久久久 99在线视频免费 伊人久久中文字幕久久cm 久久精品成人免费看 久久这里只有精品首页 88国产精品视频一区二区三区 中文字幕日本在线mv视频精品 国产在线精品成人一区二区三区 伊人精品线视天天综合 亚洲一区二区黄色 国产尤物视频在线 亚洲精品99久久久久中文字幕 国产一区二区三区免费观看 伊人久久大香线蕉综合电影网 国产成人精品区在线观看 日本精品一区二区三区视频 日韩高清在线二区 久久免费播放视频 一区二区成人国产精品 国产精品免费精品自在线观看 亚洲精品视频二区 麻豆国产精品有码在线观看 精品日本一区二区 亚洲欧洲久久 久久中文字幕综合婷婷 中文字幕视频在线 国产成人精品综合在线观看 91精品国产91久久久久福利 精液呈暗黄色 香蕉国产综合久久猫咪 国产专区精品 亚洲精品无码不卡 国产永久视频 亚洲成a人片在线播放观看国产 一区二区国产在线播放 亚洲一区二区黄色 欧美日韩在线观看视频 亚洲精品另类 久久国产综合尤物免费观看 国产一区二区三区国产精品 高清视频一区 国产精品igao视频 国产精品资源在线 久久综合精品国产一区二区三区 www.五月婷婷 精品色综合 99热国产免费 麻豆福利影院 亚洲伊人久久大香线蕉苏妲己 久久电影院久久国产 久久精品伊人 在线日韩理论午夜中文电影 亚洲国产欧洲综合997久久 伊人国产精品 久草国产精品 欧美一区精品二区三区 亚洲成人高清在线 91免费国产精品 日韩精品福利在线 国产一线在线观看 国产不卡在线看 久久99青青久久99久久 亚洲精品亚洲人成在线播放 99久久免费看国产精品 国产日本在线观看 青草国产在线视频 麻豆久久婷婷国产综合五月 国产中文字幕一区 91久久精品国产性色也91久久 国产一区a 国产欧美日韩成人 国产亚洲女在线精品 一区二区美女 中文字幕在线2021一区 在线小视频国产 久久这里只有精品首页 国产在线第三页 欧美日韩中文字幕 在线亚洲+欧美+日本专区 精品国产一区二区三区不卡 久久这里精品 欧美在线va在线播放 精液呈暗黄色 91精品国产手机 91在线免费播放 欧美视频亚洲色图 欧美国产日韩精品 日韩高清不卡在线 精品视频免费观看 欧美日韩一区二区三区四区 国产欧美亚洲精品第二区首页 亚洲韩精品欧美一区二区三区 国产精品视频免费 在线精品小视频 久久午夜夜伦伦鲁鲁片 国产无套在线播放 久热这里只精品99re8久 欧美久久久久 久久香蕉国产线看观看精品蕉 国产成人精品男人的天堂538 亚洲人成网站色7799在线观看 日韩在线第二页 一本色道久久综合狠狠躁篇 国产一区二区三区不卡在线观看 亚洲乱码在线 在线观看欧美国产 久久福利青草精品资源站免费 国产玖玖在线观看 在线亚洲精品 亚洲成aⅴ人在线观看 精品91在线 欧美一区二三区 日韩中文字幕视频在线 日本成人一区二区 日韩免费专区 国内精品在线观看视频 久久国产综合尤物免费观看 国产精品系列在线观看 一本一道久久a久久精品综合 亚洲免费播放 久久精品国产免费 久久人精品 亚洲毛片网站 亚洲成a人一区二区三区 韩国福利一区二区三区高清视频 亚洲精品天堂在线 一区二区三区中文字幕 亚洲国产色婷婷精品综合在线观看 亚洲国产成人久久笫一页 999国产视频 国产精品香港三级在线电影 欧美日韩一区二区三区四区 日韩国产欧美 国产精品99一区二区三区 午夜国产精品理论片久久影院 亚洲精品中文字幕麻豆 亚洲国产高清视频 久久免费手机视频 日韩a在线观看 五月婷婷亚洲 亚洲精品中文字幕麻豆 中文字幕丝袜 www国产精品 亚洲天堂精品在线 亚洲乱码一区 国产日韩欧美三级 久久999精品 伊人热人久久中文字幕 久热国产在线视频 国产欧美日韩在线观看一区二区三区 国产一二三区在线 日韩国产欧美 91精品国产91久久久久 亚洲一区小说区中文字幕 精品一区二区免费视频 国产精品视频免费 国产精品亚洲综合色区韩国 亚洲国产精品成人午夜在线观看 欧美国产日韩精品 中文字幕精品一区二区精品