• <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ī)劃
    国产老妇伦熟女老妇高清| 人妻系列 视频| 色综合亚洲欧美另类图片| 欧美日韩精品成人综合77777| 久久国产乱子免费精品| 亚洲欧美精品自产自拍| 看免费成人av毛片| 天堂中文最新版在线下载 | 校园人妻丝袜中文字幕| 干丝袜人妻中文字幕| 免费一级毛片在线播放高清视频| 一级黄色大片毛片| 国产成人91sexporn| 岛国在线免费视频观看| 啦啦啦啦在线视频资源| 欧美日本视频| 村上凉子中文字幕在线| 日韩成人av中文字幕在线观看| 国产人妻一区二区三区在| 天堂影院成人在线观看| 久久久久久久久久久免费av| 精品国产三级普通话版| 久久99热这里只频精品6学生 | 免费看日本二区| 哪个播放器可以免费观看大片| 三级男女做爰猛烈吃奶摸视频| 少妇熟女aⅴ在线视频| 欧美激情久久久久久爽电影| 国产亚洲精品av在线| 国产69精品久久久久777片| 毛片一级片免费看久久久久| 日韩成人av中文字幕在线观看| 午夜老司机福利剧场| 午夜爱爱视频在线播放| 成人亚洲精品av一区二区| 亚洲国产精品国产精品| 亚洲中文字幕日韩| 国产成人精品婷婷| 久久久国产成人免费| 又黄又爽又刺激的免费视频.| 波野结衣二区三区在线| 国产精品国产三级国产av玫瑰| 国产在视频线精品| 青春草视频在线免费观看| 夜夜看夜夜爽夜夜摸| 亚洲怡红院男人天堂| 久久6这里有精品| 又爽又黄无遮挡网站| 91狼人影院| 日本五十路高清| 综合色av麻豆| 欧美成人精品欧美一级黄| 欧美人与善性xxx| 日产精品乱码卡一卡2卡三| 成人特级av手机在线观看| 午夜爱爱视频在线播放| 色5月婷婷丁香| 国产亚洲5aaaaa淫片| 日韩强制内射视频| 久久精品国产99精品国产亚洲性色| 亚洲国产日韩欧美精品在线观看| 亚洲精品日韩av片在线观看| 日本爱情动作片www.在线观看| 99热这里只有是精品在线观看| 中文字幕av在线有码专区| ponron亚洲| 变态另类丝袜制服| 51国产日韩欧美| 成人午夜精彩视频在线观看| 久久99蜜桃精品久久| 久久久精品欧美日韩精品| 国产中年淑女户外野战色| 亚洲人成网站在线观看播放| 亚洲成人精品中文字幕电影| 色播亚洲综合网| 精品99又大又爽又粗少妇毛片| 少妇熟女aⅴ在线视频| 色噜噜av男人的天堂激情| 男女边吃奶边做爰视频| 久久婷婷人人爽人人干人人爱| 亚洲精品456在线播放app| av女优亚洲男人天堂| 三级毛片av免费| 国产v大片淫在线免费观看| 久久精品熟女亚洲av麻豆精品 | 亚州av有码| 乱系列少妇在线播放| 亚洲国产色片| 又爽又黄无遮挡网站| 日韩国内少妇激情av| 3wmmmm亚洲av在线观看| 亚洲国产精品成人久久小说| 男人狂女人下面高潮的视频| 国产精品国产高清国产av| 亚洲怡红院男人天堂| 亚洲va在线va天堂va国产| 天堂网av新在线| 大话2 男鬼变身卡| 九色成人免费人妻av| 99久久精品国产国产毛片| 青春草视频在线免费观看| 日本免费一区二区三区高清不卡| 男女边吃奶边做爰视频| 18禁动态无遮挡网站| 99久久九九国产精品国产免费| 免费播放大片免费观看视频在线观看 | 六月丁香七月| 国产探花在线观看一区二区| 日本五十路高清| 天美传媒精品一区二区| 午夜久久久久精精品| 亚洲电影在线观看av| 国产成人精品婷婷| 一级av片app| 三级经典国产精品| 国产亚洲91精品色在线| 久久久国产成人精品二区| 人妻制服诱惑在线中文字幕| 国产男人的电影天堂91| 久久久久性生活片| 看十八女毛片水多多多| 变态另类丝袜制服| 国产精品蜜桃在线观看| 大话2 男鬼变身卡| 日日干狠狠操夜夜爽| 亚洲精品乱码久久久v下载方式| 熟女电影av网| 在线观看美女被高潮喷水网站| 成人二区视频| 一级黄色大片毛片| 久久久久久国产a免费观看| 国产精品国产三级国产专区5o | 一本一本综合久久| 中文字幕av在线有码专区| 亚洲欧美日韩无卡精品| 午夜老司机福利剧场| 国产精品电影一区二区三区| 亚洲成人中文字幕在线播放| 亚洲四区av| 久久这里有精品视频免费| av播播在线观看一区| 亚洲av熟女| 尤物成人国产欧美一区二区三区| 日本五十路高清| 色播亚洲综合网| 精品久久久久久成人av| 精品国内亚洲2022精品成人| 黄色欧美视频在线观看| 白带黄色成豆腐渣| 日韩一本色道免费dvd| 亚洲欧美成人综合另类久久久 | 亚洲精品456在线播放app| 久久久欧美国产精品| 欧美日韩在线观看h| 卡戴珊不雅视频在线播放| 99久久成人亚洲精品观看| 边亲边吃奶的免费视频| 国产精品女同一区二区软件| 欧美成人午夜免费资源| 1000部很黄的大片| 搡老妇女老女人老熟妇| 午夜精品一区二区三区免费看| 日韩av在线免费看完整版不卡| 视频中文字幕在线观看| 麻豆乱淫一区二区| 大又大粗又爽又黄少妇毛片口| 国产成人午夜福利电影在线观看| 亚洲最大成人中文| 国产精品无大码| 成人特级av手机在线观看| 岛国在线免费视频观看| 毛片女人毛片| 一级av片app| 久久鲁丝午夜福利片| 午夜日本视频在线| 日韩大片免费观看网站 | 老司机福利观看| 欧美日本视频| 国产亚洲5aaaaa淫片| 97在线视频观看| 亚洲精品456在线播放app| 在线天堂最新版资源| 中文字幕熟女人妻在线| 丝袜喷水一区| 日本色播在线视频| 欧美xxxx性猛交bbbb| 少妇熟女aⅴ在线视频| 国产精品国产三级国产av玫瑰| 少妇熟女欧美另类| 欧美不卡视频在线免费观看| 男女国产视频网站| 亚洲国产精品久久男人天堂| 汤姆久久久久久久影院中文字幕 | 国产黄色视频一区二区在线观看 | 大香蕉97超碰在线| 日本熟妇午夜| 久久久久久国产a免费观看| 久久久久久久国产电影| 日韩人妻高清精品专区| 卡戴珊不雅视频在线播放| 一级毛片aaaaaa免费看小| 国产精品无大码| 99久久精品国产国产毛片| 欧美日韩国产亚洲二区| 国产黄a三级三级三级人| 亚洲精品456在线播放app| 国产极品精品免费视频能看的| 最近视频中文字幕2019在线8| 国产久久久一区二区三区| 国产女主播在线喷水免费视频网站 | 一夜夜www| 真实男女啪啪啪动态图| www日本黄色视频网| 一本一本综合久久| 一级黄色大片毛片| 我要搜黄色片| 秋霞伦理黄片| 99久久中文字幕三级久久日本| 国产午夜精品论理片| 国产精品国产三级国产av玫瑰| 国产69精品久久久久777片| 国产精品久久久久久久电影| 视频中文字幕在线观看| 久久久久久久久中文| 草草在线视频免费看| 国产麻豆成人av免费视频| 免费无遮挡裸体视频| 变态另类丝袜制服| 又黄又爽又刺激的免费视频.| 少妇人妻一区二区三区视频| 国产美女午夜福利| 国产极品精品免费视频能看的| 舔av片在线| 婷婷色av中文字幕| 日日摸夜夜添夜夜添av毛片| 亚洲av中文av极速乱| 99九九线精品视频在线观看视频| 精品一区二区三区视频在线| 欧美97在线视频| 欧美精品一区二区大全| 91av网一区二区| 亚洲av男天堂| a级毛片免费高清观看在线播放| 99在线视频只有这里精品首页| 亚洲国产精品国产精品| 中文亚洲av片在线观看爽| 日日撸夜夜添| 美女cb高潮喷水在线观看| 亚洲三级黄色毛片| 精品人妻偷拍中文字幕| 日本一二三区视频观看| 国产白丝娇喘喷水9色精品| 久久久久久国产a免费观看| 高清在线视频一区二区三区 | 国产精品嫩草影院av在线观看| 国产毛片a区久久久久| 少妇的逼好多水| 久久精品国产亚洲av天美| 又粗又爽又猛毛片免费看| 一区二区三区免费毛片| 中文资源天堂在线| 黑人高潮一二区| 亚洲人成网站在线播| 国产精品综合久久久久久久免费| 噜噜噜噜噜久久久久久91| 久久久色成人| 日本色播在线视频| av免费在线看不卡| 欧美日本亚洲视频在线播放| 最近视频中文字幕2019在线8| 免费看av在线观看网站| 免费av不卡在线播放| 黑人高潮一二区| 少妇人妻精品综合一区二区| 国产午夜精品论理片| 男人舔女人下体高潮全视频| 毛片一级片免费看久久久久| 亚洲av成人精品一区久久| 日韩av不卡免费在线播放| 乱人视频在线观看| 国产一级毛片在线| h日本视频在线播放| 最近最新中文字幕免费大全7| 国产人妻一区二区三区在| 欧美激情国产日韩精品一区| 九九久久精品国产亚洲av麻豆| 综合色丁香网| 男人的好看免费观看在线视频| 晚上一个人看的免费电影| 熟女电影av网| 精品久久久久久久久av| 建设人人有责人人尽责人人享有的 | 中文字幕精品亚洲无线码一区| 精品国产露脸久久av麻豆 | 国产淫片久久久久久久久| 欧美人与善性xxx| 久久99精品国语久久久| 18+在线观看网站| 看免费成人av毛片| 日日啪夜夜撸| av又黄又爽大尺度在线免费看 | 国产69精品久久久久777片| 精品少妇黑人巨大在线播放 | 亚洲精品乱码久久久v下载方式| 免费观看在线日韩| a级毛片免费高清观看在线播放| 国产色爽女视频免费观看| 色噜噜av男人的天堂激情| 久久久国产成人精品二区| 神马国产精品三级电影在线观看| 国产成人aa在线观看| 身体一侧抽搐| 99在线视频只有这里精品首页| 熟女电影av网| 国产精华一区二区三区| 欧美三级亚洲精品| 插阴视频在线观看视频| 国产精品一区二区在线观看99 | 大香蕉97超碰在线| 亚洲欧美精品自产自拍| 老司机影院成人| 精品国产一区二区三区久久久樱花 | 国产美女午夜福利| 精品熟女少妇av免费看| 精品久久久久久久末码| 赤兔流量卡办理| 成人毛片60女人毛片免费| 国产乱人偷精品视频| 久久久久久九九精品二区国产| 有码 亚洲区| 久久精品久久久久久久性| 精品酒店卫生间| 少妇被粗大猛烈的视频| 美女内射精品一级片tv| 国产白丝娇喘喷水9色精品| 观看美女的网站| 尾随美女入室| 国产精品女同一区二区软件| 久久久久免费精品人妻一区二区| 一级毛片久久久久久久久女| 欧美+日韩+精品| 国产高清国产精品国产三级 | 天堂√8在线中文| 亚洲av成人精品一区久久| 高清日韩中文字幕在线| 99热这里只有是精品50| 日韩大片免费观看网站 | 色噜噜av男人的天堂激情| 久热久热在线精品观看| 久久久久精品久久久久真实原创| 日本三级黄在线观看| 午夜a级毛片| 99久国产av精品| 村上凉子中文字幕在线| 晚上一个人看的免费电影| 亚洲国产精品sss在线观看| 麻豆精品久久久久久蜜桃| 国产成人aa在线观看| 国产一级毛片七仙女欲春2| 美女cb高潮喷水在线观看| 亚洲中文字幕日韩| 99在线视频只有这里精品首页| 国产精品久久久久久久电影| 欧美色视频一区免费| 1000部很黄的大片| 最近的中文字幕免费完整| 一区二区三区高清视频在线| 成人性生交大片免费视频hd| 日韩人妻高清精品专区| a级毛色黄片| 神马国产精品三级电影在线观看| 麻豆av噜噜一区二区三区| 亚洲乱码一区二区免费版| 啦啦啦啦在线视频资源| 欧美日韩精品成人综合77777| 亚洲欧美精品综合久久99| 久久国产乱子免费精品| 高清毛片免费看| 亚洲伊人久久精品综合 | 少妇丰满av| 中文字幕制服av| 国产亚洲5aaaaa淫片| 国产亚洲一区二区精品| 欧美日韩精品成人综合77777| 亚洲国产成人一精品久久久| 日本午夜av视频| 中文字幕亚洲精品专区| 亚洲美女视频黄频| 日本一本二区三区精品| 国产一区二区亚洲精品在线观看| 午夜免费男女啪啪视频观看| 一级二级三级毛片免费看| 欧美激情国产日韩精品一区| 卡戴珊不雅视频在线播放| 波野结衣二区三区在线| 亚洲av免费高清在线观看| 国产女主播在线喷水免费视频网站 | 国产乱来视频区| 日产精品乱码卡一卡2卡三| 麻豆av噜噜一区二区三区| 亚洲国产精品sss在线观看| 午夜福利成人在线免费观看| 亚洲av.av天堂| 国产 一区 欧美 日韩| 国产精品国产三级国产av玫瑰| 成人美女网站在线观看视频| 菩萨蛮人人尽说江南好唐韦庄 | 内地一区二区视频在线| 国产色爽女视频免费观看| 1000部很黄的大片| 久久精品久久精品一区二区三区| 免费观看精品视频网站| 久久99热这里只有精品18| 狂野欧美激情性xxxx在线观看| 亚洲在线自拍视频| 亚洲怡红院男人天堂| 麻豆av噜噜一区二区三区| 亚洲精品乱码久久久久久按摩| 1024手机看黄色片| 黄色日韩在线| 嫩草影院新地址| 欧美+日韩+精品| 欧美一区二区亚洲| 国产在线男女| 国产av不卡久久| 国产大屁股一区二区在线视频| 热99在线观看视频| 中文字幕免费在线视频6| 日韩欧美精品v在线| 青春草国产在线视频| av在线蜜桃| 亚洲精品国产av成人精品| 伦理电影大哥的女人| 嫩草影院精品99| 成人综合一区亚洲| 亚洲国产欧美在线一区| 99久久成人亚洲精品观看| 亚洲成人中文字幕在线播放| 最近2019中文字幕mv第一页| 永久网站在线| 97热精品久久久久久| 国产精品国产高清国产av| 亚洲av一区综合| av专区在线播放| 国产精品人妻久久久影院| 亚洲不卡免费看| 亚洲自拍偷在线| 国产精品国产三级国产专区5o | 观看美女的网站| 中文字幕av在线有码专区| 亚洲国产欧美在线一区| 级片在线观看| 成人三级黄色视频| 人妻系列 视频| 天天躁夜夜躁狠狠久久av| 久久久久久伊人网av| 欧美一区二区精品小视频在线| 嫩草影院新地址| 久久亚洲国产成人精品v| 久久久久久久午夜电影| 亚洲天堂国产精品一区在线| 亚洲美女视频黄频| 99热这里只有是精品在线观看| 两个人的视频大全免费| 97热精品久久久久久| 三级经典国产精品| av在线播放精品| 国产伦理片在线播放av一区| 亚洲国产欧美在线一区| 特大巨黑吊av在线直播| 亚洲精品久久久久久婷婷小说 | 真实男女啪啪啪动态图| 久久99热这里只有精品18| 国产不卡一卡二| 亚洲四区av| 欧美最新免费一区二区三区| or卡值多少钱| 色5月婷婷丁香| 少妇裸体淫交视频免费看高清| 免费人成在线观看视频色| 免费av毛片视频| 啦啦啦啦在线视频资源| av在线观看视频网站免费| 在线免费观看不下载黄p国产| 日本黄色视频三级网站网址| 国产成人aa在线观看| www日本黄色视频网| 国产一区有黄有色的免费视频 | 床上黄色一级片| 久久久久免费精品人妻一区二区| 一区二区三区免费毛片| 又粗又爽又猛毛片免费看| 成人二区视频| 免费不卡的大黄色大毛片视频在线观看 | 国产伦一二天堂av在线观看| 一级毛片我不卡| 国产三级中文精品| 久久精品国产亚洲av天美| 有码 亚洲区| 日韩,欧美,国产一区二区三区 | 亚洲精品久久久久久婷婷小说 | 亚洲国产精品sss在线观看| 乱码一卡2卡4卡精品| 久久久久久大精品| .国产精品久久| 亚洲欧美一区二区三区国产| 午夜a级毛片| 欧美潮喷喷水| 91久久精品国产一区二区成人| 午夜福利在线观看免费完整高清在| 最近2019中文字幕mv第一页| 精品国产三级普通话版| 天堂av国产一区二区熟女人妻| 日本爱情动作片www.在线观看| 精品熟女少妇av免费看| 免费看av在线观看网站| 日韩三级伦理在线观看| 欧美日本视频| 亚洲av日韩在线播放| 最近的中文字幕免费完整| 国内揄拍国产精品人妻在线| 尤物成人国产欧美一区二区三区| 美女黄网站色视频| 国产免费又黄又爽又色| 久久精品久久精品一区二区三区| 亚洲电影在线观看av| 毛片女人毛片| 国内少妇人妻偷人精品xxx网站| 又爽又黄无遮挡网站| 黑人高潮一二区| 少妇的逼水好多| 亚洲国产精品成人综合色| 中文天堂在线官网| 成年av动漫网址| 高清av免费在线| 岛国毛片在线播放| 日韩 亚洲 欧美在线| 亚洲美女视频黄频| 欧美高清成人免费视频www| videossex国产| 日本免费一区二区三区高清不卡| 亚洲不卡免费看| 亚洲精品国产成人久久av| 欧美最新免费一区二区三区| 久久久久性生活片| 美女黄网站色视频| 日韩国内少妇激情av| 久久久久网色| 婷婷色综合大香蕉| 秋霞伦理黄片| 色播亚洲综合网| 亚洲精品自拍成人| 乱码一卡2卡4卡精品| 我要搜黄色片| 午夜福利网站1000一区二区三区| 久久久久久久国产电影| a级毛片免费高清观看在线播放| 夫妻性生交免费视频一级片| 三级国产精品片| 日韩三级伦理在线观看| 成人高潮视频无遮挡免费网站| 日韩亚洲欧美综合| 欧美日韩精品成人综合77777| 久久精品熟女亚洲av麻豆精品 | 乱系列少妇在线播放| 热99在线观看视频| 久久亚洲国产成人精品v| 毛片女人毛片| 少妇丰满av| 人人妻人人看人人澡| 亚洲综合精品二区| 村上凉子中文字幕在线| 亚洲三级黄色毛片| 天天躁日日操中文字幕| 波多野结衣高清无吗| 级片在线观看| 一夜夜www| 国产乱人视频| 久久久久久久久久久丰满| 18禁在线播放成人免费| 1000部很黄的大片| 色尼玛亚洲综合影院| 免费大片18禁| 国内精品美女久久久久久| 亚洲人成网站在线播| 中文字幕熟女人妻在线| 寂寞人妻少妇视频99o| 国产91av在线免费观看| 舔av片在线| 大话2 男鬼变身卡| 欧美成人午夜免费资源| 18禁在线播放成人免费| 亚洲av二区三区四区| 亚洲国产精品成人久久小说| 国产午夜精品久久久久久一区二区三区| 国产一级毛片在线| www日本黄色视频网| 久久99热这里只频精品6学生 | 你懂的网址亚洲精品在线观看 | 中文天堂在线官网| 国产乱来视频区| 国产一区二区三区av在线| 国产精品麻豆人妻色哟哟久久 | 午夜爱爱视频在线播放| 男的添女的下面高潮视频| 成人亚洲精品av一区二区| 国产黄a三级三级三级人| 国产毛片a区久久久久| 成人av在线播放网站| 国产 一区精品| 亚洲人成网站高清观看| 欧美一区二区亚洲| 熟女电影av网| 建设人人有责人人尽责人人享有的 | 天天一区二区日本电影三级|