• <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ī)劃
    只有这里有精品99| 久久ye,这里只有精品| av电影中文网址| 欧美成人精品欧美一级黄| 午夜视频国产福利| 亚洲一区二区三区欧美精品| 欧美国产精品一级二级三级| a级毛片黄视频| 伊人久久国产一区二区| 最近中文字幕2019免费版| 最新中文字幕久久久久| 亚洲婷婷狠狠爱综合网| 国产精品久久久久久精品古装| 午夜免费男女啪啪视频观看| 日韩一本色道免费dvd| 久久人人爽人人爽人人片va| 国产精品一区www在线观看| 伊人久久国产一区二区| 免费高清在线观看日韩| 日韩大片免费观看网站| 老司机亚洲免费影院| 久久精品国产a三级三级三级| 亚洲国产日韩一区二区| 少妇人妻 视频| 久久青草综合色| 妹子高潮喷水视频| 黄色配什么色好看| 亚洲国产精品专区欧美| 99久久精品国产国产毛片| 伊人久久国产一区二区| 国产免费福利视频在线观看| 午夜久久久在线观看| 免费日韩欧美在线观看| 久久这里有精品视频免费| 国产女主播在线喷水免费视频网站| 我的女老师完整版在线观看| 日韩亚洲欧美综合| 天天影视国产精品| 国产永久视频网站| 亚洲综合色网址| 卡戴珊不雅视频在线播放| 亚洲精品中文字幕在线视频| 国产精品99久久久久久久久| 精品国产乱码久久久久久小说| 久久久久久久精品精品| 狠狠精品人妻久久久久久综合| 国产探花极品一区二区| 欧美人与性动交α欧美精品济南到 | 国产亚洲最大av| 曰老女人黄片| 国产不卡av网站在线观看| 男女边摸边吃奶| 一级毛片电影观看| 国产69精品久久久久777片| kizo精华| 欧美日韩精品成人综合77777| 午夜免费鲁丝| 飞空精品影院首页| .国产精品久久| 亚洲国产av影院在线观看| 王馨瑶露胸无遮挡在线观看| 日本欧美视频一区| 久久久亚洲精品成人影院| 国产成人精品婷婷| 亚洲欧美日韩另类电影网站| 国产毛片在线视频| 免费播放大片免费观看视频在线观看| 毛片一级片免费看久久久久| 九九爱精品视频在线观看| 国产成人精品在线电影| 一本色道久久久久久精品综合| 婷婷色综合www| 免费黄频网站在线观看国产| 日韩人妻高清精品专区| 激情五月婷婷亚洲| 久久人人爽人人片av| 国产精品不卡视频一区二区| 日韩中字成人| 精品久久久精品久久久| h视频一区二区三区| 国产精品 国内视频| 亚洲av福利一区| 国产老妇伦熟女老妇高清| 欧美97在线视频| 成人毛片60女人毛片免费| 2018国产大陆天天弄谢| 婷婷色av中文字幕| 成人亚洲欧美一区二区av| 亚洲综合色惰| 九色亚洲精品在线播放| 日韩,欧美,国产一区二区三区| 久久精品久久久久久噜噜老黄| 亚洲高清免费不卡视频| 久久狼人影院| 国产精品偷伦视频观看了| 黑人欧美特级aaaaaa片| 乱人伦中国视频| 九九在线视频观看精品| 国国产精品蜜臀av免费| 美女视频免费永久观看网站| 久久国产精品大桥未久av| 日本vs欧美在线观看视频| 大香蕉97超碰在线| 精品人妻在线不人妻| 视频在线观看一区二区三区| 自拍欧美九色日韩亚洲蝌蚪91| 亚洲美女视频黄频| 亚洲无线观看免费| 男女免费视频国产| 十八禁网站网址无遮挡| 大陆偷拍与自拍| 天天躁夜夜躁狠狠久久av| 亚洲欧美成人综合另类久久久| 免费av中文字幕在线| 国产高清有码在线观看视频| 亚洲国产精品成人久久小说| 热99国产精品久久久久久7| 麻豆精品久久久久久蜜桃| 丁香六月天网| 国产色爽女视频免费观看| 国产探花极品一区二区| 国产极品天堂在线| 国产精品免费大片| 成人无遮挡网站| 中文字幕亚洲精品专区| 男人添女人高潮全过程视频| 久久久久国产网址| 最近中文字幕2019免费版| 婷婷色麻豆天堂久久| 啦啦啦在线观看免费高清www| av女优亚洲男人天堂| 久久毛片免费看一区二区三区| 久久久亚洲精品成人影院| 亚洲欧美成人综合另类久久久| 黄色怎么调成土黄色| 久久久久久人妻| 欧美日韩一区二区视频在线观看视频在线| 在线观看国产h片| 亚洲精品国产av蜜桃| 最近中文字幕2019免费版| 午夜激情久久久久久久| 女的被弄到高潮叫床怎么办| 我的老师免费观看完整版| 久久久精品94久久精品| 伊人久久国产一区二区| 欧美亚洲 丝袜 人妻 在线| 国精品久久久久久国模美| 高清在线视频一区二区三区| 汤姆久久久久久久影院中文字幕| 欧美日韩国产mv在线观看视频| 久久国产精品男人的天堂亚洲 | 国产熟女午夜一区二区三区 | 中文天堂在线官网| 国产成人免费无遮挡视频| 亚洲av成人精品一区久久| 午夜日本视频在线| 99九九在线精品视频| 大又大粗又爽又黄少妇毛片口| 欧美日韩成人在线一区二区| 久久韩国三级中文字幕| 热99久久久久精品小说推荐| 久久久久久久久大av| 精品人妻熟女av久视频| 国产精品99久久久久久久久| 高清av免费在线| 啦啦啦啦在线视频资源| 成年美女黄网站色视频大全免费 | 国产高清三级在线| 人人妻人人澡人人爽人人夜夜| 日韩av在线免费看完整版不卡| 五月玫瑰六月丁香| 婷婷色综合www| 久久精品国产鲁丝片午夜精品| 国产av精品麻豆| 多毛熟女@视频| 飞空精品影院首页| 天堂中文最新版在线下载| 在线观看国产h片| 乱人伦中国视频| 一级,二级,三级黄色视频| 91在线精品国自产拍蜜月| 国产精品麻豆人妻色哟哟久久| 精品人妻偷拍中文字幕| 一区二区三区免费毛片| 久热这里只有精品99| 欧美bdsm另类| 亚洲精品成人av观看孕妇| 看十八女毛片水多多多| 国产片内射在线| 内地一区二区视频在线| 欧美亚洲 丝袜 人妻 在线| 亚洲婷婷狠狠爱综合网| 在线精品无人区一区二区三| 国产国拍精品亚洲av在线观看| 国产精品久久久久久精品古装| 免费观看av网站的网址| 午夜免费鲁丝| 少妇的逼水好多| 少妇人妻 视频| 黄色视频在线播放观看不卡| 性高湖久久久久久久久免费观看| 国产视频首页在线观看| 一个人免费看片子| 国产极品粉嫩免费观看在线 | 成人亚洲欧美一区二区av| 国产视频首页在线观看| 国产日韩欧美在线精品| 亚洲美女视频黄频| 欧美丝袜亚洲另类| 成人毛片60女人毛片免费| 免费观看性生交大片5| 精品一区二区三卡| 国产一区二区在线观看av| 最近的中文字幕免费完整| 伦理电影大哥的女人| 夫妻午夜视频| 久久久国产欧美日韩av| 欧美人与性动交α欧美精品济南到 | 满18在线观看网站| 少妇丰满av| 一二三四中文在线观看免费高清| 自线自在国产av| 永久免费av网站大全| 9色porny在线观看| 国产爽快片一区二区三区| 国产精品一区二区三区四区免费观看| 成人毛片60女人毛片免费| 亚州av有码| 日韩欧美精品免费久久| 麻豆乱淫一区二区| 日韩一区二区视频免费看| 亚洲激情五月婷婷啪啪| 人人澡人人妻人| 精品99又大又爽又粗少妇毛片| 国产男女超爽视频在线观看| 亚洲av成人精品一二三区| 99九九在线精品视频| 天天影视国产精品| 成人毛片a级毛片在线播放| av一本久久久久| 亚洲成人一二三区av| 成人免费观看视频高清| 少妇人妻久久综合中文| 一区二区三区四区激情视频| 高清在线视频一区二区三区| 啦啦啦在线观看免费高清www| 人妻人人澡人人爽人人| av在线老鸭窝| 人妻夜夜爽99麻豆av| 精品久久国产蜜桃| 在线观看www视频免费| 国产欧美亚洲国产| 国产一区二区在线观看日韩| 99久久综合免费| 日韩视频在线欧美| 久久久午夜欧美精品| 日韩成人av中文字幕在线观看| 老熟女久久久| 午夜免费男女啪啪视频观看| 少妇高潮的动态图| 69精品国产乱码久久久| 国国产精品蜜臀av免费| 丝袜脚勾引网站| 国产欧美亚洲国产| 成人国产麻豆网| 黑人欧美特级aaaaaa片| 亚洲成人一二三区av| 岛国毛片在线播放| 国产精品免费大片| 亚洲国产欧美日韩在线播放| 99国产综合亚洲精品| 欧美精品国产亚洲| 亚洲成人一二三区av| 精品熟女少妇av免费看| 午夜久久久在线观看| 三上悠亚av全集在线观看| 大话2 男鬼变身卡| 中国国产av一级| 欧美 日韩 精品 国产| 亚洲经典国产精华液单| 91久久精品国产一区二区三区| 99久久人妻综合| 久久久亚洲精品成人影院| 99九九线精品视频在线观看视频| 18禁观看日本| 午夜福利网站1000一区二区三区| 久久人人爽av亚洲精品天堂| 国产高清三级在线| 制服诱惑二区| 嫩草影院入口| 国产免费又黄又爽又色| 国产极品粉嫩免费观看在线 | 夜夜爽夜夜爽视频| 91aial.com中文字幕在线观看| 大香蕉97超碰在线| 日韩,欧美,国产一区二区三区| 草草在线视频免费看| 中文字幕精品免费在线观看视频 | 人妻夜夜爽99麻豆av| 久久精品久久精品一区二区三区| 久久狼人影院| 亚洲色图 男人天堂 中文字幕 | 草草在线视频免费看| 下体分泌物呈黄色| 欧美人与善性xxx| 又大又黄又爽视频免费| 大香蕉97超碰在线| 亚洲中文av在线| 久久久久人妻精品一区果冻| 精品人妻一区二区三区麻豆| av播播在线观看一区| 最后的刺客免费高清国语| 丁香六月天网| 大香蕉久久成人网| 少妇猛男粗大的猛烈进出视频| 涩涩av久久男人的天堂| 亚洲欧美一区二区三区黑人 | 亚洲av二区三区四区| 在线观看三级黄色| 一边摸一边做爽爽视频免费| 人妻制服诱惑在线中文字幕| 成人国产av品久久久| 在线观看国产h片| 蜜桃久久精品国产亚洲av| 国产女主播在线喷水免费视频网站| 天堂8中文在线网| 午夜福利视频在线观看免费| 午夜日本视频在线| 人妻人人澡人人爽人人| 全区人妻精品视频| 日本欧美国产在线视频| 在线看a的网站| 婷婷色综合www| 国产高清不卡午夜福利| 久久午夜综合久久蜜桃| 久久精品国产亚洲网站| 久久久久国产精品人妻一区二区| 人妻一区二区av| 在线观看三级黄色| 欧美成人精品欧美一级黄| 男女免费视频国产| 日本爱情动作片www.在线观看| 99热这里只有精品一区| 国产精品久久久久久久电影| 搡老乐熟女国产| 国产在线一区二区三区精| 亚洲av国产av综合av卡| 国产成人a∨麻豆精品| 一级毛片aaaaaa免费看小| 久久精品国产自在天天线| 国产精品久久久久久精品电影小说| 高清视频免费观看一区二区| 亚洲av男天堂| 韩国高清视频一区二区三区| 99国产综合亚洲精品| 在线观看国产h片| 乱码一卡2卡4卡精品| 2022亚洲国产成人精品| 人妻人人澡人人爽人人| 国产av码专区亚洲av| 王馨瑶露胸无遮挡在线观看| 在线天堂最新版资源| 性色avwww在线观看| 国产av精品麻豆| 91精品国产国语对白视频| 日本黄色日本黄色录像| 国产成人免费无遮挡视频| 国产成人精品福利久久| 嫩草影院入口| 日本免费在线观看一区| 色婷婷久久久亚洲欧美| 久久人妻熟女aⅴ| 欧美 亚洲 国产 日韩一| 国产熟女欧美一区二区| 亚洲精品日本国产第一区| 国产免费一级a男人的天堂| 亚洲av免费高清在线观看| 你懂的网址亚洲精品在线观看| 夜夜骑夜夜射夜夜干| 欧美三级亚洲精品| 国产精品一区www在线观看| 久久久久久久久久久久大奶| 在线免费观看不下载黄p国产| 亚洲av中文av极速乱| 99热全是精品| 国产熟女午夜一区二区三区 | 中文欧美无线码| 婷婷成人精品国产| 免费播放大片免费观看视频在线观看| av在线app专区| 亚洲av.av天堂| 又黄又爽又刺激的免费视频.| 国产精品人妻久久久影院| 最近2019中文字幕mv第一页| 国产永久视频网站| 韩国高清视频一区二区三区| 看非洲黑人一级黄片| 自线自在国产av| 国产成人91sexporn| 午夜福利视频在线观看免费| 国产男女内射视频| 欧美激情 高清一区二区三区| 黄片播放在线免费| 女性生殖器流出的白浆| 一本大道久久a久久精品| 男女免费视频国产| 亚洲五月色婷婷综合| 免费人妻精品一区二区三区视频| 18禁动态无遮挡网站| 人人妻人人澡人人看| 高清毛片免费看| 精品久久久久久电影网| 国产免费又黄又爽又色| 日韩强制内射视频| 久久精品国产亚洲av涩爱| 人人妻人人添人人爽欧美一区卜| av有码第一页| 中文字幕精品免费在线观看视频 | 精品久久国产蜜桃| 色5月婷婷丁香| 国产黄片视频在线免费观看| 人人妻人人澡人人爽人人夜夜| 性色avwww在线观看| 亚洲国产精品一区二区三区在线| 国产片特级美女逼逼视频| 一级,二级,三级黄色视频| 日本黄色片子视频| 一区二区av电影网| 少妇精品久久久久久久| 男女高潮啪啪啪动态图| 十八禁网站网址无遮挡| 日韩欧美精品免费久久| 成人毛片a级毛片在线播放| 韩国av在线不卡| 成人黄色视频免费在线看| 熟妇人妻不卡中文字幕| 国产欧美另类精品又又久久亚洲欧美| 久热这里只有精品99| 欧美性感艳星| 波野结衣二区三区在线| 热99国产精品久久久久久7| 久久免费观看电影| 飞空精品影院首页| 成人国语在线视频| 久久久欧美国产精品| 日本爱情动作片www.在线观看| 国产免费现黄频在线看| 中文乱码字字幕精品一区二区三区| 亚洲一区二区三区欧美精品| 中文字幕亚洲精品专区| 亚州av有码| 午夜免费男女啪啪视频观看| 免费观看无遮挡的男女| 日韩av免费高清视频| 亚洲精品久久成人aⅴ小说 | 久久这里有精品视频免费| 久久综合国产亚洲精品| 黑丝袜美女国产一区| 亚洲国产色片| 久久99蜜桃精品久久| 欧美成人午夜免费资源| 欧美精品国产亚洲| 亚洲久久久国产精品| 99久久综合免费| 我的老师免费观看完整版| 99热这里只有是精品在线观看| 国产欧美日韩综合在线一区二区| 午夜影院在线不卡| 亚洲国产精品一区三区| 久久国产精品大桥未久av| av女优亚洲男人天堂| 街头女战士在线观看网站| 亚洲人成网站在线播| 精品一区二区免费观看| 80岁老熟妇乱子伦牲交| 免费观看无遮挡的男女| 大话2 男鬼变身卡| 超碰97精品在线观看| 菩萨蛮人人尽说江南好唐韦庄| 美女中出高潮动态图| 人人澡人人妻人| 成人亚洲欧美一区二区av| 国产 精品1| 免费观看a级毛片全部| 丁香六月天网| 青春草亚洲视频在线观看| videosex国产| 午夜激情av网站| 一区在线观看完整版| 国产亚洲精品第一综合不卡 | 亚洲五月色婷婷综合| 欧美bdsm另类| 精品视频人人做人人爽| 啦啦啦中文免费视频观看日本| 看十八女毛片水多多多| 国产 精品1| 婷婷色综合大香蕉| 亚洲三级黄色毛片| 国产成人av激情在线播放 | 久久国产亚洲av麻豆专区| 中文字幕人妻丝袜制服| 麻豆精品久久久久久蜜桃| 九九久久精品国产亚洲av麻豆| 亚洲丝袜综合中文字幕| 免费观看无遮挡的男女| 国产女主播在线喷水免费视频网站| 亚洲成人一二三区av| 成人国产av品久久久| 成人18禁高潮啪啪吃奶动态图 | 91在线精品国自产拍蜜月| 免费观看在线日韩| 国产无遮挡羞羞视频在线观看| 亚洲av男天堂| 日韩成人伦理影院| 国产免费视频播放在线视频| 高清黄色对白视频在线免费看| 国产精品久久久久久精品古装| 亚洲一级一片aⅴ在线观看| 国产精品国产av在线观看| 国产成人免费无遮挡视频| 天天操日日干夜夜撸| 欧美日韩亚洲高清精品| 少妇的逼好多水| 国产欧美亚洲国产| 欧美日韩av久久| 99热国产这里只有精品6| 男女无遮挡免费网站观看| 久久青草综合色| 满18在线观看网站| 中文字幕制服av| 午夜激情久久久久久久| www.av在线官网国产| a级毛片黄视频| 欧美bdsm另类| 午夜视频国产福利| 国模一区二区三区四区视频| 蜜臀久久99精品久久宅男| 伊人久久国产一区二区| 亚洲av电影在线观看一区二区三区| .国产精品久久| 秋霞在线观看毛片| 色吧在线观看| 久久精品国产亚洲av涩爱| 老司机亚洲免费影院| 69精品国产乱码久久久| 日韩一区二区视频免费看| 国产成人a∨麻豆精品| 亚洲精品乱码久久久久久按摩| 国产深夜福利视频在线观看| 久久ye,这里只有精品| 99国产综合亚洲精品| 韩国高清视频一区二区三区| 国产一区亚洲一区在线观看| 99国产精品免费福利视频| 99久久精品国产国产毛片| 日本色播在线视频| 久久狼人影院| 亚洲成人手机| av在线观看视频网站免费| 乱人伦中国视频| 99九九线精品视频在线观看视频| 欧美xxⅹ黑人| 亚洲精品国产av蜜桃| a级毛片免费高清观看在线播放| 久久国产精品大桥未久av| a级毛色黄片| 国产一区亚洲一区在线观看| 黄色配什么色好看| 国产黄色视频一区二区在线观看| 草草在线视频免费看| 欧美老熟妇乱子伦牲交| 欧美 亚洲 国产 日韩一| 美女主播在线视频| 午夜视频国产福利| av电影中文网址| 哪个播放器可以免费观看大片| 精品一品国产午夜福利视频| 男男h啪啪无遮挡| 美女大奶头黄色视频| 亚洲精品一区蜜桃| 国产成人av激情在线播放 | av电影中文网址| 欧美日韩视频精品一区| 在线观看免费视频网站a站| 国产精品久久久久久av不卡| 亚洲精品日韩在线中文字幕| videos熟女内射| 人人澡人人妻人| 中文天堂在线官网| 亚洲少妇的诱惑av| xxxhd国产人妻xxx| 亚洲激情五月婷婷啪啪| 丝袜喷水一区| 亚洲欧美日韩卡通动漫| 婷婷色麻豆天堂久久| 亚洲av成人精品一区久久| 久久国产亚洲av麻豆专区| 久久99精品国语久久久| 精品一区二区三卡| 一区二区三区免费毛片| 亚洲熟女精品中文字幕| 国产av一区二区精品久久| 日韩免费高清中文字幕av| 少妇被粗大猛烈的视频| 另类亚洲欧美激情| 婷婷色综合www| 又大又黄又爽视频免费| 久久av网站| 男人爽女人下面视频在线观看| 一区二区av电影网| 久久久久久久久久成人| 亚洲欧美中文字幕日韩二区| 亚洲av.av天堂| www.av在线官网国产| 麻豆精品久久久久久蜜桃|