• <tr id="yyy80"></tr>
  • <sup id="yyy80"></sup>
  • <tfoot id="yyy80"><noscript id="yyy80"></noscript></tfoot>
  • 99热精品在线国产_美女午夜性视频免费_国产精品国产高清国产av_av欧美777_自拍偷自拍亚洲精品老妇_亚洲熟女精品中文字幕_www日本黄色视频网_国产精品野战在线观看 ?

    基于雙預(yù)瞄純追蹤算法的丘陵山區(qū)農(nóng)機(jī)差分導(dǎo)航系統(tǒng)研究

    2024-05-22 21:18:33陳柯霖謝守勇陳翀向旺劉偉
    關(guān)鍵詞:路徑規(guī)劃

    陳柯霖 謝守勇 陳翀 向旺 劉偉

    摘要:針對丘陵山區(qū)農(nóng)業(yè)機(jī)械因體積小、種類多,難以無人作業(yè)改造的問題,搭建基于雙預(yù)瞄純追蹤算法的丘陵山區(qū)農(nóng)機(jī)差分導(dǎo)航系統(tǒng),完成導(dǎo)航系統(tǒng)結(jié)構(gòu)、路徑規(guī)劃策略和追蹤控制器的設(shè)計(jì)。使用Ntrip DTU和北斗定位板卡完成差分定位。采用平滑轉(zhuǎn)向方式,提出適用于丘陵山區(qū)的全局路徑規(guī)劃策略,可有效適配不同轉(zhuǎn)彎半徑的農(nóng)機(jī),減少地頭區(qū)域。設(shè)計(jì)雙預(yù)瞄純追蹤模糊控制器,開展與純追蹤控制器的對比仿真試驗(yàn),并搭建試驗(yàn)樣機(jī)完成測試。實(shí)際測試結(jié)果顯示:控制器在追蹤直線時(shí),在s=2.9 m處收斂,在之后的直線追蹤中平均絕對誤差保持在0.01 m;在追蹤曲線時(shí),兩段彎道最大誤差分別為0.08 m和0.75 m,平均絕對誤差0.04 m。

    關(guān)鍵詞:丘陵山區(qū);差分導(dǎo)航;路徑規(guī)劃;純追蹤;雙預(yù)瞄模糊控制器

    中圖分類號:S24

    文獻(xiàn)標(biāo)識碼:A

    文章編號:20955553 (2024) 02018707

    收稿日期:2023年2月13日 ?修回日期:2023年5月18日

    基金項(xiàng)目:中國煙草總公司重慶市煙草專賣局(公司)科技計(jì)劃項(xiàng)目(B20211NY1317);重慶市技術(shù)創(chuàng)新與應(yīng)用發(fā)展專項(xiàng)重點(diǎn)項(xiàng)目(cstc2021jscx—gksbX0065)

    第一作者:陳柯霖,男,1996年生,四川成都人,碩士;研究方向?yàn)檗r(nóng)業(yè)智能裝備。Email: 1083106951@qq.com

    通訊作者:謝守勇,男,1969年生,重慶人,博士,教授;研究方向?yàn)橹悄苻r(nóng)業(yè)裝備開發(fā)。Email: zswu0310@163.com

    Research on differential navigation system of agricultural machinery in hilly areas

    based on dual preview pure tracking algorithm

    Chen Kelin, Xie Shouyong, Chen Chong, Xiang Wang, Liu Wei

    (College of Engineering and Technology, Southwest University, Chongqing, 400715, China)

    Abstract:

    In order to solve the problem that agricultural machinery in hilly areas is difficult to be transformed by unmanned operation due to its small size and many kinds, a differential navigation system for agricultural machinery in hilly and mountainous areas based on double preview tracking algorithm was built, and the navigation system structure, path planning strategy and tracking controller were designed. Ntrip DTU and Beidou positioning board card were used to complete differential positioning. A global path planning strategy suitable for hilly and mountainous areas was proposed by using smooth steering mode, which could effectively adapt to agricultural machinery with different turning radius and reduce field area. The dual preview pure tracking fuzzy controller was designed, and the simulation experiment was carried out compared with the pure tracking controller, and the experimental prototype was built to complete the test. The actual test results showed that the controller proposed in this paper converged?at s=2.9 m when tracking the straight line, and the average absolute error remained at 0.01 m in the following straight line tracking. When tracking the curve, the maximum error of the two curves was 0.08 m and 0.75 m respectively, and the average absolute error was 0.04 m.

    Keywords:

    hilly areas; differential navigation; path planning; pure tracking; double preview fuzzy controller

    0 引言

    傳感器、物聯(lián)網(wǎng)和云計(jì)算等技術(shù)的應(yīng)用,推動了現(xiàn)代農(nóng)業(yè)向著智能化、信息化、精細(xì)化發(fā)展[1],其中衛(wèi)星導(dǎo)航技術(shù)的應(yīng)用尤其廣泛[2]。根據(jù)《2021年全國農(nóng)業(yè)機(jī)械化發(fā)展統(tǒng)計(jì)公報(bào)》,2021年中國加裝北斗衛(wèi)星導(dǎo)航系統(tǒng)的農(nóng)用車輛超過60萬臺,植保無人機(jī)保有量97931架,同比增長39.22%[3],大幅提高了作業(yè)效率和農(nóng)業(yè)智能化水平。

    農(nóng)業(yè)車輛衛(wèi)星導(dǎo)航系統(tǒng)包含完整可靠的硬件基礎(chǔ)、精準(zhǔn)的路徑追蹤控制器[45]和高效的路徑規(guī)劃策略[6],目前國內(nèi)外學(xué)者對此都有大量的研究。在追蹤控制器的研究上,柴善鵬等[7]在溫室農(nóng)機(jī)上使用粒子群優(yōu)化算法優(yōu)化純追蹤追蹤控制器,以提高控制精度。黎永鍵等[8]在東方紅拖拉機(jī)上搭建雙閉環(huán)轉(zhuǎn)向控制的自動導(dǎo)航系統(tǒng)。王立輝等[9]依托雷沃谷神收獲機(jī)搭建自適應(yīng)路徑追蹤系統(tǒng)。刁勤晴等[10]通過雙預(yù)瞄策略解決了跟蹤大曲率路徑時(shí)車速過高的問題。Ahn等[11]通過改變前瞻點(diǎn)與路徑的幾何位置,改進(jìn)了純追蹤算法,解決了震蕩和轉(zhuǎn)彎半徑過小問題。靳欣宇等[12]提出了一種基于最優(yōu)預(yù)瞄時(shí)間的Stanley追蹤控制器,實(shí)現(xiàn)了復(fù)雜道路的無人駕駛。

    同時(shí),在對導(dǎo)航系統(tǒng)核心技術(shù)之一——路徑規(guī)劃的研究上[13],翟衛(wèi)欣等[14]提出了一種基于區(qū)塊套行作業(yè)模式的路徑規(guī)劃方法。孟志軍等[15] 根據(jù)車輛和田地的先驗(yàn)信息,選擇不同的優(yōu)化目標(biāo)計(jì)算出最優(yōu)路徑。劉剛等[16]提出了一種基于地塊平整度的全局路徑規(guī)劃方法,提高平地效率30%以上。Rahman等[17]使用N多邊形算法和凸包分裂交叉點(diǎn)法完成凸凹多邊形田地路徑規(guī)劃,減少了作物損失和工作時(shí)間。Han等[18]提出了基于X形轉(zhuǎn)向的多邊形地塊路徑規(guī)劃算法,提高了作業(yè)質(zhì)量。

    上述導(dǎo)航系統(tǒng)使用的控制器和路徑規(guī)劃策略效果顯著,但主要適用于特定類型的農(nóng)機(jī)和場景,硬件結(jié)構(gòu)相對零散并需要車載計(jì)算機(jī)的輔助,成本較高、缺乏靈活性。而丘陵山區(qū)農(nóng)機(jī)種類多、農(nóng)機(jī)體積小,要求導(dǎo)航系統(tǒng)擴(kuò)展性高、成本低,便于二次開發(fā)。為此本文基于純追蹤算法和RTK(Realtime kinematic)定位技術(shù)搭建丘陵山區(qū)小型農(nóng)機(jī)導(dǎo)航控制系統(tǒng),完成系統(tǒng)硬件搭建,提出適用于丘陵山區(qū)的路徑規(guī)劃策略和雙預(yù)瞄純追蹤模糊控制器,并對控制器進(jìn)行仿真和試驗(yàn),驗(yàn)證其準(zhǔn)確性和有效性。

    1 系統(tǒng)設(shè)計(jì)

    1.1 自動導(dǎo)航系統(tǒng)結(jié)構(gòu)組成

    導(dǎo)航系統(tǒng)結(jié)構(gòu)由控制終端、被控端、執(zhí)行機(jī)構(gòu)控制端、定位裝置、網(wǎng)絡(luò)端組成,如圖1所示。

    系統(tǒng)被控端芯片采用STM32F407VET6,移植freeRTOS(Free Real Time Operating System),支持任務(wù)創(chuàng)建,享有獨(dú)立的堆??臻g,通過時(shí)間片流轉(zhuǎn)和全搶占式調(diào)度,從宏觀上實(shí)現(xiàn)多線程、多優(yōu)先級處理[19]。系統(tǒng)數(shù)據(jù)儲存由SD卡和可擦可編程只讀存儲器(EEPROM)組成,SD卡用以儲存導(dǎo)航路點(diǎn),移植FATFS文件系統(tǒng)[20],可完成路徑點(diǎn)文件(夾)的創(chuàng)建、寫入、刪除、搜索,EEPROM儲存用戶設(shè)備參數(shù)。串口屏作為人機(jī)交互界面,通SI24R1射頻模組與被控端連接,完成遠(yuǎn)程通信。使用4G模組接入網(wǎng)絡(luò),提高系統(tǒng)可擴(kuò)展性,配置TCP(Transmission Control Protocol)通道工作模式,進(jìn)行數(shù)據(jù)透傳,由socket網(wǎng)絡(luò)編程搭建服務(wù)器,可在服務(wù)器端完成數(shù)據(jù)上傳、儲存、處理、下載、可視化等功能,并為復(fù)雜算法提供空間和算力。定位裝置使用北斗高精度定位定向板卡UB482,定位精度1cm,航向角精度0.2°/1m基線。由千尋DTU(Data Transfer unit)接收服務(wù)商固定站的差分?jǐn)?shù)據(jù),無需現(xiàn)場搭建固定站。數(shù)據(jù)以NMEA消息協(xié)議傳輸至系統(tǒng)解碼,獲取當(dāng)前坐標(biāo)、速度、航向角。執(zhí)行單元由STM32F103VET6作為主控,由RS232接口與系統(tǒng)通信并預(yù)留CAN通訊接口。根據(jù)系統(tǒng)功能需要設(shè)計(jì)PCB主板,并將大小控制在13cm×15cm,符合輕量化設(shè)計(jì),更加適用于小型農(nóng)機(jī)。

    1.2 任務(wù)創(chuàng)建與數(shù)據(jù)處理

    系統(tǒng)依托freeRTOS,創(chuàng)建四種任務(wù)類型。數(shù)據(jù)傳輸類任務(wù)用于整合外部通信接口,與系統(tǒng)內(nèi)部建立通道;數(shù)據(jù)處理類任務(wù)用于預(yù)處理定位數(shù)據(jù)及解析命令、根據(jù)命令調(diào)用路徑規(guī)劃和路徑追蹤功能;數(shù)據(jù)存儲類任務(wù)用于完成數(shù)據(jù)的存儲和調(diào)用;人機(jī)交互類任務(wù)為用戶提供觸摸屏輸入界面以及操作按鍵。采用串口DMA(Direct Memory Access)中斷接收定位數(shù)據(jù),接收與解碼輪轉(zhuǎn),避免數(shù)據(jù)丟失問題。在中斷中引入二進(jìn)制信號量,完成數(shù)據(jù)接收與解碼任務(wù)的同步,建立消息隊(duì)列等待其他任務(wù)對定位數(shù)據(jù)請求。以“$cmd+命令符+文件名+#”規(guī)則建立命令,在數(shù)據(jù)處理任務(wù)中解析字符串,設(shè)置事件組中對應(yīng)位實(shí)現(xiàn)多任務(wù)之間的同步。

    2 路徑規(guī)劃策略

    丘陵山區(qū)田塊面積相對較小,邊緣規(guī)整度低,為提高土地使用效率,提出一種轉(zhuǎn)彎地頭小、對車輛適應(yīng)性高、生成路徑規(guī)整度好的規(guī)劃策略。將田塊分為自主作業(yè)區(qū)和遙控作業(yè)區(qū),在自主作業(yè)區(qū)使用跨行次數(shù)nc來量化通勤路線長度,以減小地頭轉(zhuǎn)彎區(qū)域?yàn)橹?,減少通勤路線長度為輔規(guī)劃路徑。在遙控作業(yè)區(qū),對人工遙控作業(yè)產(chǎn)生的路點(diǎn)全程采集并存儲,可供自主作業(yè)二次調(diào)用。

    2.1 作業(yè)區(qū)和作業(yè)帶劃分

    在獲取經(jīng)緯度信息后,因其單位跨度較大,將其轉(zhuǎn)化為通用墨卡爾投影(UTM)下的位置信息。通過四點(diǎn)圈定田塊,規(guī)整為四邊形,分別計(jì)算四邊與對邊端點(diǎn)的最大距離,選擇其中最小距離d3對應(yīng)的邊l3作為起始邊,以作業(yè)寬幅w等距切分起始邊最短鄰邊l1,生成n條作業(yè)帶,使得作業(yè)條數(shù)和轉(zhuǎn)彎次數(shù)最少,作業(yè)帶中心線即為自主作業(yè)路徑雛形,同時(shí)劃出了自主和遙控作業(yè)區(qū),如圖2所示。

    2.2 自主作業(yè)區(qū)轉(zhuǎn)向方式及路徑規(guī)劃

    根據(jù)車輛轉(zhuǎn)彎半徑r和作業(yè)條數(shù)n,分割地頭區(qū)域。本文自主作業(yè)區(qū)采用平滑轉(zhuǎn)向[11],在轉(zhuǎn)彎半徑較大時(shí),使用跨行平滑轉(zhuǎn)向代替常用的Ω形轉(zhuǎn)向掉頭,見圖3。

    (a) Ω形轉(zhuǎn)向

    (b) 平滑轉(zhuǎn)向

    由幾何關(guān)系可得,平滑轉(zhuǎn)向?qū)D(zhuǎn)彎地頭區(qū)域要求長度與α和r有關(guān),當(dāng)邊界為斜邊時(shí),根據(jù)相切的兩直線生成轉(zhuǎn)向圓弧,轉(zhuǎn)彎區(qū)域長度

    h1=r·sin(90°-α)+w2

    (1)

    而常用的Ω形轉(zhuǎn)向,轉(zhuǎn)彎區(qū)域長度

    h2=2rsinarccosw+2r4r+r+w2

    (2)

    由式(1)和式(2)知,平滑轉(zhuǎn)向相較于常用的Ω形轉(zhuǎn)向,占用地頭轉(zhuǎn)彎區(qū)域更少。

    當(dāng)r≤1/2w時(shí),無需跨行轉(zhuǎn)向,地頭轉(zhuǎn)彎區(qū)域較小,以梭行法[11]生成作業(yè)路徑,能夠減少通勤路線長度,此時(shí)跨行次數(shù)nc=n,如圖4(a)所示。

    當(dāng)r>1/2w時(shí),需轉(zhuǎn)向跨行,使用結(jié)行法規(guī)劃路徑,如圖4(b)所示。結(jié)行法最小作業(yè)條數(shù)ns與轉(zhuǎn)彎半徑r、作業(yè)寬幅w相關(guān),按式(3)計(jì)算,在相同轉(zhuǎn)彎半徑和作業(yè)寬幅下,該方法較于常用的套行法[11],每條作業(yè)帶所消耗的通勤路徑更短,且要求的最小作業(yè)條數(shù)更小,擴(kuò)大了適用范圍,如圖4(c)所示,在轉(zhuǎn)彎最小跨行數(shù)都為2且車輛同側(cè)進(jìn)出的狀態(tài)下,滿足結(jié)行法的最小作業(yè)行數(shù)為4,而套行法為6。對于結(jié)行法,其跨行次數(shù)nc按式(4)計(jì)算。

    ns=2×2rw r≥12w

    (3)

    nc=4∑n2i=1i-3

    (4)

    由式知當(dāng)作業(yè)條數(shù)為4時(shí),nc最小,作業(yè)條數(shù)增多時(shí),nc增速上升,為減小通勤路線長度,將其分組,如圖4(d)所示。以最小作業(yè)條數(shù)為一組,將n條作業(yè)路徑分為gs個(gè)最小組和1個(gè)作業(yè)條數(shù)為nf剩余組。其中g(shù)s和nf分別按式(5)、式(6)計(jì)算。

    gs=nns-1

    (5)

    nf=n-gs·ns

    (6)

    (a) 梭行法,r

    (b) 結(jié)行法,n=4

    (c) 結(jié)行與套行對比

    (d) 組合法

    3 雙預(yù)瞄純追蹤模糊控制器設(shè)計(jì)

    3.1 農(nóng)機(jī)運(yùn)動模型分析

    對路徑進(jìn)行精確追蹤是導(dǎo)航系統(tǒng)的主要功能,而實(shí)現(xiàn)這一功能需要對農(nóng)業(yè)機(jī)械轉(zhuǎn)向模型進(jìn)行分析,丘陵山區(qū)常用的農(nóng)機(jī)運(yùn)動轉(zhuǎn)向模型為阿克曼轉(zhuǎn)向和履帶差速轉(zhuǎn)向兩類。在質(zhì)心和幾何中心重合且不計(jì)車輪滑移的條件下對兩類模型分析,如圖5所示。

    (a) 阿克曼轉(zhuǎn)向模型

    (b) 履帶差速轉(zhuǎn)向模型

    對農(nóng)機(jī)轉(zhuǎn)向模型進(jìn)行運(yùn)動學(xué)分析,將阿克曼轉(zhuǎn)向模型簡化成自行車模型,如圖5(a)所示,可得轉(zhuǎn)彎半徑與前輪航向角關(guān)系如式(7)所示。

    tanβ2=dr

    (7)

    對于履帶式農(nóng)機(jī),將其等效為二輪差速模型,如圖5(b)所示,其中虛擬輪距dv與實(shí)際工況變化的參數(shù)相關(guān)[21],根據(jù)運(yùn)動學(xué)分析可得式(8)。

    r=v2dr=(v1+v3)×dv2(v3-v1)

    (8)

    由以上分析得,阿克曼轉(zhuǎn)向和履帶差速轉(zhuǎn)向可分別通過改變前輪轉(zhuǎn)向角和左右履帶速度來獲取期望的轉(zhuǎn)彎半徑。為此系統(tǒng)采用通過改變轉(zhuǎn)彎半徑來追蹤目標(biāo)的純追蹤算法,該算法對追蹤路徑的連續(xù)性要求低,系統(tǒng)路徑可采用點(diǎn)間隔0.2m的路點(diǎn)形式存儲,加入雙預(yù)瞄模糊控制器提高追蹤精度。面對不同種類的農(nóng)機(jī),只需要修改執(zhí)行機(jī)構(gòu)端程序完成轉(zhuǎn)彎半徑的控制以適配系統(tǒng)。

    3.2 雙預(yù)瞄純追蹤幾何模型分析

    純追蹤算法是通過車輛的橫向偏差和到預(yù)瞄點(diǎn)的航向偏差計(jì)算出期望轉(zhuǎn)彎半徑,對純追蹤模型進(jìn)行分析如圖6所示。

    通過分析可得式(9)。

    ldsinα=rsinπ-2α2

    (9)

    簡化可得半徑與前視距離的關(guān)系如式(10)所示。

    r=ld2sinα

    (10)

    由式(10)可知,純追蹤法所得的期望轉(zhuǎn)彎半徑r與ld、α有關(guān)。其中α根據(jù)實(shí)際位置計(jì)算得知,ld為系統(tǒng)設(shè)定值,并且追蹤性能極大地取決于ld的大小。當(dāng)ld較小時(shí),跟蹤更加精準(zhǔn),但過小的前視距離也會帶來震蕩,而較大的前視距離意味著跟蹤軌跡越平滑,但在彎曲道路上,跟蹤精度會下降。

    3.3 雙預(yù)瞄純追蹤模糊控制器設(shè)計(jì)

    確定一個(gè)合適的前視距離,提高追蹤精度,更加有利于農(nóng)機(jī)在丘陵山區(qū)作業(yè)。本文使用雙預(yù)瞄和模糊算法建立純追蹤控制器。第一預(yù)瞄點(diǎn)對道路曲折度進(jìn)行評估,算法從最近路點(diǎn)開始向前搜索路點(diǎn)直到最大前視距離位置,計(jì)算搜索到的相鄰路點(diǎn)連線的平均夾角大小,用于評估道路曲折度,第二預(yù)瞄點(diǎn)即為由前視距離確定的跟蹤目標(biāo)點(diǎn),見圖6。模糊控制器輸入為橫向偏差和曲折度,輸出為前視距離,對輸入輸出模糊化。

    橫向偏差論域?yàn)?2~2 m,量化等級負(fù)大(NB),負(fù)中(NM),負(fù)?。∟S),零(ZO),正?。≒S),正中(PM),正大(PB)。

    道路曲折度論域 0°~8°,量化等級超?。╒S),?。⊿),中(M),大(B),超大(VB)。

    前視距離論域0.5~2.5 m,量化等級超?。╒S),?。⊿),中(M),大(B),超大(VB)。

    根據(jù)車輛駕駛經(jīng)驗(yàn),當(dāng)橫向偏差較大、道路曲折時(shí),減小前視距離,預(yù)瞄近點(diǎn),以快速逼近路線,更精準(zhǔn)的跟蹤路徑。當(dāng)橫向偏差小、道路端直時(shí),增大前視距離,使行駛路徑更加平滑?;谏鲜鲴{駛經(jīng)驗(yàn),經(jīng)過專家經(jīng)驗(yàn)設(shè)計(jì)的三維模糊控制器共有35條控制規(guī)則,如表1所示,模糊控制曲面如圖7所示。

    4 路點(diǎn)追蹤仿真

    為測試雙預(yù)瞄純追蹤模糊控制器的可靠性,建立阿克曼轉(zhuǎn)向模型,設(shè)定車輛軸距1m。取固定前視距離1.6m和控制器輸出的動態(tài)前視距離,使用Python編寫控制器程序,根據(jù)上述路徑規(guī)劃策略特點(diǎn)生成追蹤路點(diǎn),完成直線和曲線追蹤仿真實(shí)驗(yàn)。

    4.1 直線追蹤仿真

    以起點(diǎn)(0,1)、終點(diǎn)(0,13),點(diǎn)間隔0.2m生成直線路點(diǎn),車輛起始位置(0,0),航向角0°,追蹤路點(diǎn),仿真結(jié)果如圖8、圖9所示。

    直線路徑曲折度為0,從起點(diǎn)開始橫向誤差較大,此時(shí)控制器輸出較短的前視距離,使車輛快速逼近路徑,在s=2.65m時(shí)處接近路點(diǎn),使追蹤誤差減少到0.1m以內(nèi),固定前視距離則在s=4.2m時(shí)誤差接近0.1m。動態(tài)距離輸出最大反向誤差約為0.04m,固定距離最大反向誤差約為0.03m,差值0.01m,但使用動態(tài)距離可快速地將誤差逼近到小范圍內(nèi),以滿足作業(yè)要求。隨著橫向誤差減小,控制器輸出較長的前視距離,車輛平緩靠近路點(diǎn),并在s=7m時(shí)將追蹤誤差減小到0.01m以內(nèi)。

    4.2 曲線追蹤仿真

    以起點(diǎn)(0,-2),終點(diǎn)(6,-2),半徑2.5m生成兩段曲線路點(diǎn)。車輛起點(diǎn)(0,0),航向角90°,追蹤路點(diǎn),仿真結(jié)果如圖10、圖11所示。

    在初始階段,車輛在路徑上且航向與路徑一致,固定距離和動態(tài)距離跟蹤精度差距小。當(dāng)要進(jìn)入曲線路點(diǎn)時(shí),第一預(yù)瞄點(diǎn)向前搜索,計(jì)算出道路曲折度變大,控制器提前輸出一個(gè)較小的前視距離以更精確地追蹤路點(diǎn)。而固定距離在道路變曲折時(shí),未作出相應(yīng)改變,導(dǎo)致轉(zhuǎn)彎半徑變小,從而偏離路點(diǎn)。

    車輛在s=2m處進(jìn)入曲線路徑,誤差持續(xù)變大,在第一段曲線路徑和第二段曲線路徑中,使用固定距離的追蹤誤差分別在s=3.7m和s=9.3m時(shí)達(dá)到最大值0.22m和0.13m,動態(tài)距離則在s=3.8m和s=8.3m時(shí)達(dá)到最大值,分別為0.05m和0.06m。

    通過仿真數(shù)據(jù)知,相比于固定前視距離,使用動態(tài)前視距離追蹤直線路點(diǎn)能夠更快收斂,在追蹤曲線路點(diǎn)時(shí),精度更高。

    5 路點(diǎn)追蹤試驗(yàn)

    為驗(yàn)證系統(tǒng)和追蹤算法的可行性,改裝實(shí)驗(yàn)室現(xiàn)有小型播種機(jī)作為試驗(yàn)樣機(jī),采樣實(shí)際UTM坐標(biāo)(390 431.23,3 395 672.39)并生成作業(yè)直線與兩段曲線路徑點(diǎn)。在速度1m/s,誤差1m,航向角0°的初始狀態(tài)下分別使用固定和動態(tài)前視距離完成追蹤試驗(yàn),試驗(yàn)結(jié)果如圖12、圖13所示。

    結(jié)果表明,使用固定前視距離追蹤時(shí),車輛在s=4.2m處逼近直線路徑,并產(chǎn)生0.01m的反向誤差,在追蹤曲線路點(diǎn)階段,追蹤第一段和第二段曲線路點(diǎn)最大誤差分別為0.16m和0.11m,平均絕對誤差為0.09m,并在回到之后直線路點(diǎn)時(shí),產(chǎn)生0.08m的反向誤差。

    而使用動態(tài)前視距離追蹤時(shí),車輛在s=2.9m處逼近直線路徑,產(chǎn)生0.02m的反向誤差,在追蹤曲線路點(diǎn)時(shí),第一段和第二段曲線路點(diǎn)最大誤差為0.08m和0.075m,平均絕對誤差為0.04m。并在回到之后直線路徑時(shí),產(chǎn)生0.02m的反向誤差。兩者在追蹤直線誤差穩(wěn)定后平均絕對誤差均為0.01m。

    6 結(jié)論

    1) ?針對丘陵山區(qū)小型農(nóng)機(jī)無人作業(yè)改造難及改造成本高的問題,完成了輕量化導(dǎo)航系統(tǒng)的控制主板和遠(yuǎn)程控制終端的設(shè)計(jì),并將主板控制在13cm×15cm大小。

    2) 根據(jù)丘陵山地田塊特點(diǎn),提出了平滑轉(zhuǎn)向配合梭行法及結(jié)行法的路徑規(guī)劃策略,通過公式分析得出,該方法地頭面積更小,可適用于不同轉(zhuǎn)彎半徑的農(nóng)機(jī)。

    3) 設(shè)計(jì)出了雙預(yù)瞄純追蹤模糊控制器并進(jìn)行仿真和試驗(yàn),結(jié)果表明使用雙預(yù)瞄純追蹤模糊控制器追蹤直線路段時(shí),在s=2.9m收斂到目標(biāo)點(diǎn),相比于純追蹤控制器,提前了1.55m,且趨于穩(wěn)定后,追蹤的平均絕對誤差僅有0.01m。在進(jìn)入曲線路段時(shí),追蹤第一段和第二段的誤差分別為0.08m和0.075m,相比于純追蹤控制器,分別減少了0.08m和0.035m,有效地提高了系統(tǒng)的收斂速度,實(shí)現(xiàn)了農(nóng)機(jī)對路徑的精確追蹤。

    參 考 文 獻(xiàn)

    [1]姬長英, 周俊. 農(nóng)業(yè)機(jī)械導(dǎo)航技術(shù)發(fā)展分析[J]. 農(nóng)業(yè)機(jī)械學(xué)報(bào), 2014, 45(9): 44-54.

    Ji Changying, Zhou Jun. Current situation of navigation technologies for agricultural machinery [J].Transactions of the Chinese Society for Agricultural Machinery, 2014, 45(9): 44-54.

    [2]鐘銀, 薛夢琦, 袁洪良. 智能農(nóng)機(jī)GNSS/INS組合導(dǎo)航系統(tǒng)設(shè)計(jì)[J]. 農(nóng)業(yè)工程學(xué)報(bào), 2021, 37(9): 40-46.

    Zhong Yin, Xue Mengqi, Yuan Hongliang. Design of the GNSS/INS integrated navigation system for intelligent agricultural machinery [J]. Transactions of the Chinese Society of Agricultural Engineering, 2021, 37(9): 40-46.

    [3]農(nóng)業(yè)農(nóng)村部農(nóng)業(yè)機(jī)械化管理司. 2021年全國農(nóng)業(yè)機(jī)械化統(tǒng)計(jì)年報(bào)[M]. 2022.

    [4]黎永鍵, 趙祚喜, 黃培奎, 等. 基于CAN總線的拖拉機(jī)導(dǎo)航控制系統(tǒng)設(shè)計(jì)與試驗(yàn)[J]. 農(nóng)業(yè)機(jī)械學(xué)報(bào), 2016, 47(S1): 35-42.

    Li Yongjian, Zhao Zuoxi, Huang Peikui, et al. Design and experiment of navigation control system for tractor based on CAN bus [J]. Transactions of the Chinese Society for Agricultural Machinery, 2016, 47(S1): 35-42.

    [5]李革, 王宇, 郭劉粉, 等. 插秧機(jī)導(dǎo)航路徑跟蹤改進(jìn)純追蹤算法[J]. 農(nóng)業(yè)機(jī)械學(xué)報(bào), 2018, 49(5): 21-26.

    Li Ge, Wang Yu, Guo Liufen, et al. Improved pure pursuit algorithm for rice transplanter path tracking [J]. Transactions of the Chinese Society for Agricultural Machinery, 2018, 49(5): 21-26.

    [6]劉洋成, 耿端陽, 蘭玉彬, 等. 基于自動導(dǎo)航的農(nóng)業(yè)裝備全覆蓋路徑規(guī)劃研究進(jìn)展[J]. 中國農(nóng)機(jī)化學(xué)報(bào), 2020, 41(11): 185-192.

    Liu Yangcheng, Geng Duanyang, Lan Yubin, et al. Research progress of agricultural equipment full coverage path planning based on automatic navigation [J]. Journal of chinese Agricultural Mechanization, 2020, 41(11): 185-192.

    [7]柴善鵬, 姚立健, 徐麗君, 等. 基于動態(tài)前視距離純追蹤模型的溫室農(nóng)機(jī)路徑跟蹤研究[J]. 中國農(nóng)機(jī)化學(xué)報(bào), 2021, 42(11): 58-64, 79.

    Chai Shanpeng, Yao Lijian, Xu Lijun, et al. Research on greenhouse agricultural machinery path tracking based on dynamic look ahead distance pure pursuit model [J]. Journal of Chinese Agricultural Mechanization, 2021, 42(11): 58-64, 79.

    [8]黎永鍵, 趙祚喜, 黃培奎, 等. 基于DGPS與雙閉環(huán)控制的拖拉機(jī)自動導(dǎo)航系統(tǒng)[J]. 農(nóng)業(yè)機(jī)械學(xué)報(bào), 2017, 48(2): 11-19.

    Li Yongjian, Zhao Zuoxi, Huang Peikui, et al. Automatic navigation system of tractor based on DGPS and double closedloop steering control [J]. Transactions of the Chinese Society for Agricultural Machinery, 2017, 48(2): 11-19.

    [9]王立輝, 石佳晨, 王樂剛, 等. 智能收獲機(jī)定位和自適應(yīng)路徑追蹤方法[J]. 導(dǎo)航定位學(xué)報(bào), 2020, 8(6): 29-36.

    Wang Lihui, Shi Jiachen, Wang Legang, et al. A location and adaptive path tracking methods for intelligent harvesters [J]. Journal of Navigation and Positioning, 2020, 8(6): 29-36.

    [10]刁勤晴, 張雅妮, 朱凌云. 雙預(yù)瞄點(diǎn)智能車大曲率路徑的橫縱向模糊控制[J]. 中國機(jī)械工程, 2019, 30(12): 1445-1452.

    Diao Qinqing, Zhang Yani, Zhu Lingyun. A lateral and longitudinal fuzzy control of intelligent vehicles with double preview points for large curvature roads [J]. China Mechanical Engineering, 2019, 30(12): 1445-1452.

    [11]Ahn J, Shin S, Kim M, et al. Accurate path tracking by adjusting lookahead point in pure pursuit method [J]. International journal of automotive technology, 2021, 22: 119-129.

    [12]靳欣宇, 張軍, 劉元盛, 等. 基于Stanley算法的自適應(yīng)最優(yōu)預(yù)瞄模型研究[J]. 計(jì)算機(jī)工程, 2018, 44(7): 42-46.

    Jin Xinyu, Zhang Jun, Liu Yuansheng, et al. Research on adaptive optimal preview model based on Stanley algorithm [J].Computer Engineering, 2018, 44(7): 42-46.

    [13]周俊, 何永強(qiáng). 農(nóng)業(yè)機(jī)械導(dǎo)航路徑規(guī)劃研究進(jìn)展[J]. 農(nóng)業(yè)機(jī)械學(xué)報(bào), 2021, 52(9): 1-14.

    Zhou Jun, He Yongqiang. Research progress on navigation path planning of agricultural machinery [J]. Transactions of the Chinese Society for Agricultural Machinery, 2021, 52(9): 1-14.

    [14]翟衛(wèi)欣, 王東旭, 陳智博, 等. 無人駕駛農(nóng)機(jī)自主作業(yè)路徑規(guī)劃方法[J]. 農(nóng)業(yè)工程學(xué)報(bào), 2021, 37(16): 1-7.

    Zhai Weixin, Wang Dongxu, Chen Zhibo, et al. Autonomous operation path planning method for unmanned agricultural machinery [J]. Transactions of the Chinese Society of Agricultural Engineering, 2021, 37(16): 1-7.

    [15]孟志軍, 劉卉, 王華, 等. 農(nóng)田作業(yè)機(jī)械路徑優(yōu)化方法[J]. 農(nóng)業(yè)機(jī)械學(xué)報(bào), 2012, 43(6): 147-152.

    Meng Zhijun, Liu Hui, Wang Hua, et al. Optimal path planning for agricultural machinery [J]. Transactions of the Chinese Society for Agricultural Machinery, 2012, 43(6): 147-152.

    [16]劉剛, 康熙, 夏友祥, 等. 基于GNSS農(nóng)田平整全局路徑規(guī)劃方法與試驗(yàn)[J]. 農(nóng)業(yè)機(jī)械學(xué)報(bào), 2018, 49(5): 27-33.

    Liu Gang, Kang Xi, Xia Youxiang, et al. Global path planning algorithm and experiment based on GNSScontrolled precise land leveling system [J]. Transactions of the Chinese Society for Agricultural Machinery, 2018, 49(5): 27-33.

    [17]Rahman M M, Ishii K, Noguchi N. Optimum harvesting area of convex and concave polygon field for path planning of robot combine harvester [J]. Intelligent Service Robotics, 2019, 12: 167-179.

    [18]Han X, Kim H J, Jeon C W, et al. Design and field testing of a polygonal paddy infield path planner for unmanned tillage operations [J]. Computers and Electronics in Agriculture, 2021, 191: 106567.

    [19]熊一鵬, 岳偉. FreeRTOS多任務(wù)調(diào)度機(jī)制在監(jiān)控單元中的應(yīng)用[J]. 單片機(jī)與嵌入式系統(tǒng)應(yīng)用, 2021, 21(9): 64-66.

    Xiong Yipeng, Yue Wei. Application of multitask scheduling mechanism in FreeRTOS system in monitoring unit [J]. Microcontrollers & Embedded Systems, 2021, 21(9): 64-66.

    [20]高兆強(qiáng), 王紹舉, 徐偉, 等. FATFS在嵌入式操作系統(tǒng)FreeRTOS中的移植與應(yīng)用[J]. 現(xiàn)代電子技術(shù), 2017, 40(6): 65-67, 70.

    Gao Zhaoqiang, Wang Shaoju, Xu Wei, et al. Transplantation and application of FATFS in embedded operating system FreeRTOS [J]. Modern Electronics Technique, 2017, 40(6): 65-67, 70.

    [21]Wang T, Wu Y, Liang J, et al. Analysis and experimental kinematics of a skidsteering wheeled robot based on a laser scanner sensor [J]. Sensors, 2015, 15(5): 9681-9702.

    猜你喜歡
    路徑規(guī)劃
    綠茵舞者
    公鐵聯(lián)程運(yùn)輸和售票模式的研究和應(yīng)用
    基于數(shù)學(xué)運(yùn)算的機(jī)器魚比賽進(jìn)攻策略
    清掃機(jī)器人的新型田埂式路徑規(guī)劃方法
    自適應(yīng)的智能搬運(yùn)路徑規(guī)劃算法
    科技視界(2016年26期)2016-12-17 15:53:57
    基于B樣條曲線的無人車路徑規(guī)劃算法
    基于改進(jìn)的Dijkstra算法AGV路徑規(guī)劃研究
    科技視界(2016年20期)2016-09-29 12:00:43
    基于多算法結(jié)合的機(jī)器人路徑規(guī)劃算法
    基于Android 的地圖位置服務(wù)系統(tǒng)的設(shè)計(jì)與實(shí)現(xiàn)
    基于改進(jìn)細(xì)菌覓食算法的機(jī)器人路徑規(guī)劃
    十八禁高潮呻吟视频| 国产欧美日韩综合在线一区二区| 中文字幕人妻熟女乱码| 又大又黄又爽视频免费| 69精品国产乱码久久久| 国产国语露脸激情在线看| 成人国语在线视频| 制服人妻中文乱码| 日日爽夜夜爽网站| 女性被躁到高潮视频| 一区二区三区激情视频| 久久久久久人人人人人| 午夜影院在线不卡| 久久精品国产鲁丝片午夜精品| 久久久久久久国产电影| 国产精品久久久久成人av| 久久人人爽人人片av| 亚洲国产成人一精品久久久| 一级爰片在线观看| 人人妻人人爽人人添夜夜欢视频| 人妻一区二区av| 亚洲av日韩在线播放| 在线天堂最新版资源| 午夜福利在线观看免费完整高清在| 中文字幕人妻丝袜制服| 国产精品二区激情视频| 日本免费在线观看一区| 亚洲美女黄色视频免费看| 日韩精品有码人妻一区| av一本久久久久| 在线观看免费高清a一片| 亚洲av免费高清在线观看| 97人妻天天添夜夜摸| 精品国产超薄肉色丝袜足j| 亚洲美女搞黄在线观看| 免费黄频网站在线观看国产| 久久久a久久爽久久v久久| 午夜影院在线不卡| 一区二区日韩欧美中文字幕| 久久久精品免费免费高清| 国产不卡av网站在线观看| 亚洲国产精品999| 精品少妇黑人巨大在线播放| 日本黄色日本黄色录像| 亚洲成人av在线免费| 欧美精品人与动牲交sv欧美| 一边亲一边摸免费视频| 精品少妇一区二区三区视频日本电影 | 精品一区二区免费观看| 久久国产亚洲av麻豆专区| 香蕉精品网在线| 亚洲在久久综合| 国产精品成人在线| 美女福利国产在线| 亚洲欧美色中文字幕在线| av.在线天堂| av免费在线看不卡| 亚洲一区中文字幕在线| 成年动漫av网址| 精品福利永久在线观看| 亚洲欧洲精品一区二区精品久久久 | 久久久久久久精品精品| 丝瓜视频免费看黄片| 国产免费现黄频在线看| 日韩三级伦理在线观看| 狂野欧美激情性bbbbbb| 尾随美女入室| 国产欧美日韩综合在线一区二区| 我要看黄色一级片免费的| tube8黄色片| 精品国产乱码久久久久久男人| av免费在线看不卡| 国产精品99久久99久久久不卡 | 亚洲av中文av极速乱| 丰满乱子伦码专区| 国产精品久久久久久久久免| 夫妻性生交免费视频一级片| 午夜激情久久久久久久| 99热全是精品| 日韩熟女老妇一区二区性免费视频| 久久久久精品久久久久真实原创| 亚洲精品国产av成人精品| 久久久国产欧美日韩av| 电影成人av| 搡老乐熟女国产| 亚洲精品第二区| 黄片小视频在线播放| 国产黄频视频在线观看| 天美传媒精品一区二区| 国产日韩欧美亚洲二区| 精品福利永久在线观看| 日本av手机在线免费观看| 亚洲成人一二三区av| 日韩,欧美,国产一区二区三区| 99香蕉大伊视频| 热re99久久国产66热| 伊人久久国产一区二区| 亚洲av欧美aⅴ国产| 国产视频首页在线观看| 狠狠精品人妻久久久久久综合| 色94色欧美一区二区| 久久久久久伊人网av| 又黄又粗又硬又大视频| 熟女av电影| 国产精品一国产av| 午夜老司机福利剧场| 久久久a久久爽久久v久久| 纵有疾风起免费观看全集完整版| 综合色丁香网| 丁香六月天网| 亚洲精品久久久久久婷婷小说| 青青草视频在线视频观看| 国产欧美日韩一区二区三区在线| 日本免费在线观看一区| 制服人妻中文乱码| 亚洲少妇的诱惑av| 一级片免费观看大全| 黑人欧美特级aaaaaa片| 三上悠亚av全集在线观看| 人人妻人人澡人人爽人人夜夜| 一级毛片 在线播放| 在现免费观看毛片| 成人午夜精彩视频在线观看| 美女主播在线视频| 亚洲欧美清纯卡通| 国产成人午夜福利电影在线观看| 搡女人真爽免费视频火全软件| 日韩免费高清中文字幕av| 国产日韩欧美在线精品| 久久精品亚洲av国产电影网| 好男人视频免费观看在线| 在线观看人妻少妇| 汤姆久久久久久久影院中文字幕| 久久午夜福利片| 国产一区有黄有色的免费视频| 纵有疾风起免费观看全集完整版| 久久久久久久精品精品| 日韩视频在线欧美| 成人手机av| 啦啦啦视频在线资源免费观看| 久久精品国产a三级三级三级| 日本免费在线观看一区| 久久久久人妻精品一区果冻| 18禁观看日本| 国产成人精品久久二区二区91 | 91精品国产国语对白视频| 十八禁高潮呻吟视频| 亚洲av欧美aⅴ国产| 国产综合精华液| 亚洲图色成人| 亚洲精品视频女| 免费观看性生交大片5| 女人高潮潮喷娇喘18禁视频| freevideosex欧美| 青春草亚洲视频在线观看| 美女视频免费永久观看网站| 亚洲一码二码三码区别大吗| av国产精品久久久久影院| 久久精品国产a三级三级三级| 纵有疾风起免费观看全集完整版| 亚洲色图综合在线观看| 亚洲精品久久成人aⅴ小说| 国产一区二区三区av在线| 男男h啪啪无遮挡| 一级爰片在线观看| 视频在线观看一区二区三区| 久久精品国产综合久久久| 日韩电影二区| 26uuu在线亚洲综合色| 国产精品久久久久成人av| kizo精华| 日韩不卡一区二区三区视频在线| 免费黄色在线免费观看| 天天影视国产精品| 久久精品亚洲av国产电影网| 色婷婷久久久亚洲欧美| www.av在线官网国产| 国产97色在线日韩免费| 美女视频免费永久观看网站| 日本-黄色视频高清免费观看| 男女国产视频网站| 在线观看人妻少妇| 日韩中字成人| 少妇人妻精品综合一区二区| 免费观看av网站的网址| 高清不卡的av网站| 在线观看一区二区三区激情| 久久精品久久久久久噜噜老黄| 五月天丁香电影| 亚洲第一青青草原| 国产精品人妻久久久影院| 日韩 亚洲 欧美在线| 国产成人精品福利久久| 欧美另类一区| 国产亚洲av片在线观看秒播厂| 日韩一本色道免费dvd| 久久 成人 亚洲| 青春草视频在线免费观看| 波多野结衣一区麻豆| 99久久精品国产国产毛片| 18禁国产床啪视频网站| 欧美日韩亚洲国产一区二区在线观看 | 久久久精品国产亚洲av高清涩受| 在线免费观看不下载黄p国产| 久久久久久久久久久免费av| 色哟哟·www| 女的被弄到高潮叫床怎么办| 一级,二级,三级黄色视频| 国产av国产精品国产| 国产一区有黄有色的免费视频| 中文欧美无线码| 咕卡用的链子| 日本黄色日本黄色录像| 久久ye,这里只有精品| 国产成人精品福利久久| 亚洲国产精品一区三区| 波多野结衣av一区二区av| 中文欧美无线码| 超碰成人久久| 夫妻性生交免费视频一级片| 免费观看性生交大片5| 亚洲三级黄色毛片| 亚洲国产av影院在线观看| 国产黄色视频一区二区在线观看| 日韩熟女老妇一区二区性免费视频| 国产精品 欧美亚洲| 欧美亚洲日本最大视频资源| 男女啪啪激烈高潮av片| 一本大道久久a久久精品| 午夜福利,免费看| 久久久久视频综合| 久久精品国产亚洲av天美| 亚洲精品久久久久久婷婷小说| 亚洲综合精品二区| 女人久久www免费人成看片| 午夜久久久在线观看| 中文字幕制服av| 男女下面插进去视频免费观看| 日日爽夜夜爽网站| 人人妻人人爽人人添夜夜欢视频| 国产片内射在线| 亚洲伊人色综图| 只有这里有精品99| 最近2019中文字幕mv第一页| 国产福利在线免费观看视频| 99九九在线精品视频| 免费在线观看完整版高清| 爱豆传媒免费全集在线观看| 老熟女久久久| 哪个播放器可以免费观看大片| 人妻少妇偷人精品九色| 午夜福利在线观看免费完整高清在| 天美传媒精品一区二区| 亚洲人成网站在线观看播放| 中文字幕另类日韩欧美亚洲嫩草| 日本爱情动作片www.在线观看| 日韩精品免费视频一区二区三区| 亚洲国产av新网站| 国产无遮挡羞羞视频在线观看| 久久99一区二区三区| av卡一久久| 国产毛片在线视频| 91久久精品国产一区二区三区| 日本91视频免费播放| 两性夫妻黄色片| 丝袜脚勾引网站| 亚洲成色77777| 国产一区二区 视频在线| 国产精品麻豆人妻色哟哟久久| 69精品国产乱码久久久| videossex国产| 亚洲第一青青草原| 亚洲精品国产色婷婷电影| 丝袜喷水一区| 国产一区二区在线观看av| 精品少妇一区二区三区视频日本电影 | 香蕉精品网在线| 日韩av不卡免费在线播放| 欧美日韩av久久| 岛国毛片在线播放| 国产高清不卡午夜福利| 91精品伊人久久大香线蕉| 亚洲,欧美,日韩| 久久久久国产网址| 99热网站在线观看| 夜夜骑夜夜射夜夜干| 亚洲av欧美aⅴ国产| 久久99蜜桃精品久久| 久久久久国产精品人妻一区二区| 三上悠亚av全集在线观看| videosex国产| 久久久久久伊人网av| 国产探花极品一区二区| 五月伊人婷婷丁香| 国产精品免费视频内射| 最近最新中文字幕大全免费视频 | 天堂8中文在线网| 久热这里只有精品99| 可以免费在线观看a视频的电影网站 | 美女脱内裤让男人舔精品视频| 久久精品久久精品一区二区三区| 99国产精品免费福利视频| 国产视频首页在线观看| 国产午夜精品一二区理论片| 一级毛片电影观看| 成人午夜精彩视频在线观看| 黑人猛操日本美女一级片| tube8黄色片| 极品人妻少妇av视频| 黄色 视频免费看| 欧美日韩成人在线一区二区| 一区二区三区激情视频| 久久99蜜桃精品久久| 亚洲五月色婷婷综合| 丝袜美腿诱惑在线| 亚洲精品国产av成人精品| 国产成人精品在线电影| 国产免费一区二区三区四区乱码| 国产在线免费精品| 午夜福利视频精品| av有码第一页| 国产免费视频播放在线视频| 成人亚洲精品一区在线观看| 嫩草影院入口| 国产高清不卡午夜福利| 午夜老司机福利剧场| 午夜福利一区二区在线看| 精品亚洲乱码少妇综合久久| 99九九在线精品视频| 人人妻人人爽人人添夜夜欢视频| 欧美日韩视频高清一区二区三区二| 国产不卡av网站在线观看| 亚洲欧洲日产国产| 国产精品香港三级国产av潘金莲 | 欧美精品人与动牲交sv欧美| 国产黄色视频一区二区在线观看| 亚洲一区二区三区欧美精品| 国产精品国产三级国产专区5o| 久久免费观看电影| 侵犯人妻中文字幕一二三四区| 高清黄色对白视频在线免费看| 欧美 亚洲 国产 日韩一| 成人亚洲欧美一区二区av| 久久韩国三级中文字幕| 成人免费观看视频高清| 久久午夜福利片| 国产精品一区二区在线观看99| av在线播放精品| 精品少妇黑人巨大在线播放| 免费观看无遮挡的男女| 久久久久久久久久久免费av| 午夜老司机福利剧场| 国产男女超爽视频在线观看| 美国免费a级毛片| 成人亚洲欧美一区二区av| 亚洲婷婷狠狠爱综合网| 欧美激情高清一区二区三区 | 巨乳人妻的诱惑在线观看| 中国三级夫妇交换| 日韩视频在线欧美| 免费久久久久久久精品成人欧美视频| av视频免费观看在线观看| 97在线视频观看| 亚洲精品久久成人aⅴ小说| 亚洲内射少妇av| 男女无遮挡免费网站观看| 午夜激情久久久久久久| 午夜福利一区二区在线看| 激情五月婷婷亚洲| 国产成人一区二区在线| 啦啦啦在线免费观看视频4| 不卡视频在线观看欧美| 国产av国产精品国产| 国产成人精品福利久久| av国产久精品久网站免费入址| 黑丝袜美女国产一区| 性色avwww在线观看| 美女脱内裤让男人舔精品视频| 亚洲综合精品二区| 永久免费av网站大全| a级毛片黄视频| 日本-黄色视频高清免费观看| 午夜免费鲁丝| 欧美97在线视频| 久久婷婷青草| 成人黄色视频免费在线看| 亚洲四区av| 日韩熟女老妇一区二区性免费视频| 久久ye,这里只有精品| 亚洲美女搞黄在线观看| 视频在线观看一区二区三区| 亚洲婷婷狠狠爱综合网| 大香蕉久久网| 色视频在线一区二区三区| 亚洲第一av免费看| 精品人妻偷拍中文字幕| 美女福利国产在线| 亚洲精品一区蜜桃| 老鸭窝网址在线观看| 精品第一国产精品| 免费黄网站久久成人精品| 欧美精品一区二区大全| 亚洲,一卡二卡三卡| 在线观看免费视频网站a站| 最新中文字幕久久久久| 亚洲欧美精品综合一区二区三区 | 国产成人精品久久二区二区91 | 男女国产视频网站| 亚洲国产精品国产精品| 亚洲av中文av极速乱| 精品卡一卡二卡四卡免费| 尾随美女入室| 久久久国产一区二区| 黄色 视频免费看| 国产欧美日韩综合在线一区二区| 在线观看人妻少妇| 国产精品三级大全| 亚洲久久久国产精品| 亚洲色图综合在线观看| 国产精品av久久久久免费| 一本久久精品| 国产女主播在线喷水免费视频网站| 国产精品免费视频内射| 免费观看a级毛片全部| 999久久久国产精品视频| 国产麻豆69| 国产精品麻豆人妻色哟哟久久| 亚洲精品国产一区二区精华液| 午夜福利一区二区在线看| 国产精品女同一区二区软件| 90打野战视频偷拍视频| 免费日韩欧美在线观看| 国产精品国产三级专区第一集| av一本久久久久| 日韩精品免费视频一区二区三区| 国产一区二区 视频在线| 黄色配什么色好看| 国语对白做爰xxxⅹ性视频网站| 亚洲国产精品一区二区三区在线| 久久人人爽人人片av| 波多野结衣一区麻豆| 久久精品国产a三级三级三级| 日韩中文字幕视频在线看片| 蜜桃在线观看..| 我的亚洲天堂| 精品国产一区二区三区久久久樱花| www日本在线高清视频| 日韩av不卡免费在线播放| 另类精品久久| 国产一区二区在线观看av| 久久国产精品男人的天堂亚洲| 欧美少妇被猛烈插入视频| 人妻一区二区av| 美女福利国产在线| 午夜福利网站1000一区二区三区| 激情视频va一区二区三区| 国产国语露脸激情在线看| 亚洲精品一区蜜桃| 日韩三级伦理在线观看| 宅男免费午夜| 亚洲国产欧美网| 男女下面插进去视频免费观看| 日韩一区二区三区影片| 99热国产这里只有精品6| 日本91视频免费播放| 国产亚洲午夜精品一区二区久久| 亚洲久久久国产精品| 王馨瑶露胸无遮挡在线观看| 高清黄色对白视频在线免费看| 亚洲三区欧美一区| 搡女人真爽免费视频火全软件| 国产又爽黄色视频| 久久人人爽av亚洲精品天堂| 99精国产麻豆久久婷婷| a级毛片黄视频| 亚洲美女黄色视频免费看| 精品亚洲乱码少妇综合久久| 欧美国产精品一级二级三级| 国产在线视频一区二区| 高清欧美精品videossex| 这个男人来自地球电影免费观看 | 久久女婷五月综合色啪小说| 日韩精品免费视频一区二区三区| 天美传媒精品一区二区| 一级毛片黄色毛片免费观看视频| 免费黄色在线免费观看| 少妇人妻 视频| 美女午夜性视频免费| 啦啦啦在线观看免费高清www| 丝袜喷水一区| 亚洲色图 男人天堂 中文字幕| 极品人妻少妇av视频| 国产欧美日韩一区二区三区在线| 中文欧美无线码| 韩国高清视频一区二区三区| 2022亚洲国产成人精品| 少妇 在线观看| a级毛片在线看网站| 黄网站色视频无遮挡免费观看| 久久这里只有精品19| 午夜福利乱码中文字幕| 免费观看性生交大片5| 免费观看在线日韩| 久久久精品区二区三区| 国产97色在线日韩免费| 欧美激情 高清一区二区三区| 好男人视频免费观看在线| 日韩人妻精品一区2区三区| 国产欧美日韩一区二区三区在线| 高清av免费在线| 日本黄色日本黄色录像| 在线 av 中文字幕| 国产熟女午夜一区二区三区| 国产色婷婷99| av国产精品久久久久影院| 国产免费福利视频在线观看| 美女视频免费永久观看网站| 亚洲国产欧美在线一区| 久久精品国产亚洲av涩爱| 一级毛片我不卡| 婷婷色麻豆天堂久久| 欧美成人午夜免费资源| 男女国产视频网站| 老司机影院毛片| 秋霞在线观看毛片| 亚洲综合色惰| 18禁国产床啪视频网站| 最近手机中文字幕大全| 久久99精品国语久久久| 丝袜喷水一区| 校园人妻丝袜中文字幕| 亚洲一码二码三码区别大吗| 亚洲国产成人一精品久久久| 欧美中文综合在线视频| 90打野战视频偷拍视频| 久久人人爽人人片av| 国产成人91sexporn| 免费看不卡的av| 9191精品国产免费久久| 亚洲精品日韩在线中文字幕| 乱人伦中国视频| 国产高清国产精品国产三级| 精品国产一区二区三区久久久樱花| 国产精品国产三级国产专区5o| 亚洲av男天堂| 深夜精品福利| 久久久久网色| 成人国产麻豆网| 午夜免费男女啪啪视频观看| 精品久久久精品久久久| 欧美精品一区二区免费开放| 巨乳人妻的诱惑在线观看| 91在线精品国自产拍蜜月| 高清黄色对白视频在线免费看| 久久久久久久大尺度免费视频| 中文精品一卡2卡3卡4更新| 91精品三级在线观看| 亚洲一区中文字幕在线| 少妇人妻 视频| 18+在线观看网站| 性色avwww在线观看| 91aial.com中文字幕在线观看| 免费少妇av软件| 免费观看无遮挡的男女| 亚洲精品视频女| 91成人精品电影| 日本av手机在线免费观看| 在线看a的网站| 国产欧美日韩一区二区三区在线| www.熟女人妻精品国产| 国产av精品麻豆| 久久久久久免费高清国产稀缺| 中文精品一卡2卡3卡4更新| 女性生殖器流出的白浆| 97精品久久久久久久久久精品| 一级毛片 在线播放| 久久精品国产亚洲av涩爱| 9热在线视频观看99| 亚洲av成人精品一二三区| kizo精华| 在现免费观看毛片| 人人妻人人澡人人看| 熟女av电影| 欧美 亚洲 国产 日韩一| 久久精品国产自在天天线| av视频免费观看在线观看| 美国免费a级毛片| 69精品国产乱码久久久| 久久毛片免费看一区二区三区| 日韩欧美精品免费久久| 欧美日韩视频精品一区| 日韩欧美一区视频在线观看| 午夜91福利影院| 欧美精品一区二区免费开放| 精品一品国产午夜福利视频| 咕卡用的链子| 日韩中字成人| 少妇的逼水好多| 欧美 亚洲 国产 日韩一| 免费播放大片免费观看视频在线观看| 欧美老熟妇乱子伦牲交| 成年人午夜在线观看视频| 日韩一卡2卡3卡4卡2021年| 亚洲成av片中文字幕在线观看 | 韩国高清视频一区二区三区| 国产成人精品婷婷| 国产成人精品在线电影| 婷婷色av中文字幕| 国产精品三级大全| 一级毛片黄色毛片免费观看视频| 中文字幕亚洲精品专区| 在线观看国产h片| 午夜福利网站1000一区二区三区| 伊人久久国产一区二区| 亚洲 欧美一区二区三区|