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

    雙矢量定姿算法提高海參捕撈裝置捷聯(lián)慣導系統(tǒng)粗對準精度

    2017-10-14 14:56:02包建華李道亮
    農(nóng)業(yè)工程學報 2017年12期
    關(guān)鍵詞:捷聯(lián)慣導對準

    包建華,喬 曦,李道亮

    ?

    雙矢量定姿算法提高海參捕撈裝置捷聯(lián)慣導系統(tǒng)粗對準精度

    包建華1,2,3,喬 曦1,3,李道亮1,3※

    (1. 中國農(nóng)業(yè)大學信息與電氣工程學院,北京 100083;2. 江蘇師范大學電氣工程及自動化學院,徐州 221116;3. 北京農(nóng)業(yè)物聯(lián)網(wǎng)工程技術(shù)研究中心,北京 100083)

    針對傳統(tǒng)解析粗對準算法中水平對準精度同時受陀螺儀和加速度計測量誤差影響的問題,提出一種雙矢量定姿粗對準算法,該算法在選定重力矢量為主參考矢量的前提下,預(yù)先對參與姿態(tài)解算的矢量作單位正交化處理。理論分析表明,所述算法使得水平對準精度只受加速度計水平測量誤差影響,提高了捷聯(lián)慣導系統(tǒng)粗對準精度;實測數(shù)據(jù)的試驗結(jié)果表明,所述粗對準算法的水平誤差角的大小不超過1°,方位誤差角的大小不超過3°,在粗對準所要求的誤差范圍之內(nèi),為后續(xù)利用濾波方法進行精對準提供了有效的初始條件。

    漁業(yè);導航;算法;捷聯(lián)慣導;粗對準;雙矢量定姿;靜基座;海參捕撈

    0 引 言

    用信息技術(shù)提升農(nóng)業(yè)機械化水平是建設(shè)現(xiàn)代農(nóng)業(yè)的戰(zhàn)略選擇,為加強農(nóng)機裝備的信息技術(shù)創(chuàng)新,需要突破智能農(nóng)業(yè)裝備數(shù)字化設(shè)計、自動導航協(xié)調(diào)控制等關(guān)鍵技術(shù)[1]。農(nóng)業(yè)機械自動導航是精準農(nóng)業(yè)的重要技術(shù)支撐,已廣泛應(yīng)用于現(xiàn)代農(nóng)業(yè)生產(chǎn)各過程[2-5]。中國是海參生產(chǎn)和消費大國,目前,海參捕撈方式主要是拖網(wǎng)和人工捕撈,對潛水員的生命健康和海洋生態(tài)都有潛在危害[6]。為減輕潛水員的勞動強度,人們已開發(fā)了一些機械式捕撈裝置來代替人工進行海參捕撈[7-9],但自動化程度低,作業(yè)效率不高。因此,在當前海參養(yǎng)殖規(guī)模不斷擴大的背景下,開發(fā)一種自主式海參捕撈裝置顯得尤其迫切。自主式海參捕撈裝置關(guān)鍵要解決海參柔性抓捕和載體的自主導航定位問題。捷聯(lián)慣性導航系統(tǒng)(SINS,strapdown inertial navigation system)具有自主性和無源性的特點,已被廣泛用于飛機、艦艇、船舶等的導航[10-12],隨著低成本MEMS(micro-electro- mechanical system)慣性傳感器技術(shù)的進步,捷聯(lián)慣性導航系統(tǒng)被越來越多地應(yīng)用于民用領(lǐng)域[13]。為解決海參捕撈裝置的自主導航定位問題,課題組開展了以捷聯(lián)慣導為主的組合導航研究。

    初始對準是捷聯(lián)慣導系統(tǒng)關(guān)鍵技術(shù)之一,其目的就是在執(zhí)行導航任務(wù)之前,事先確定出載體坐標系相對導航坐標系的初始位置關(guān)系,即確定姿態(tài)矩陣的初始值,為后續(xù)捷聯(lián)解算提供必要的初始條件[14-15],因此,初始對準的好壞將直接影響導航系統(tǒng)的性能。為了既快又準地實現(xiàn)對準,捷聯(lián)慣導系統(tǒng)的初始對準過程通常分為粗對準和精對準兩個階段[16-17]。粗對準著重解決對準的快速性問題,盡快將姿態(tài)角誤差縮小到一定的范圍內(nèi),為下一步精對準提供有效的初始條件,因此,研究一種算法簡單且具有較高精度的粗對準方案有其實際的應(yīng)用價值[18-19]。傳統(tǒng)解析粗對準是直接利用重力矢量和地球自轉(zhuǎn)角速度矢量估算姿態(tài)矩陣[20],由于其水平對準精度同時受陀螺儀和加速度計測量誤差的影響,使得粗對準效果不佳。為改善水平對準精度,本文提出一種雙矢量定姿粗對準方案,并用MEMS慣性測量單元與三維電子羅盤的實測數(shù)據(jù)進行了試驗驗證。

    1 材料與方法

    1.1 坐標系規(guī)定

    1)導航坐標系文中選地理坐標系為導航坐標系,其原點位于載體重心,軸指向東,軸指向北,軸指向天。

    1.2 解析粗對準算法

    1.2.1 傳統(tǒng)解析粗對準

    傳統(tǒng)解析粗對準是借助空間兩個“不共線”的地球自轉(zhuǎn)角速度矢量和地球重力矢量,直接估算從載體坐標系到導航坐標系的初始姿態(tài)矩陣[21-22]。重力矢量、地球自轉(zhuǎn)角速度矢量在導航坐標系和載體坐標系上的投影關(guān)系可分別表示為:

    (2)

    為了求解從系到系的變換矩陣,再利用和的叉乘運算構(gòu)造一個新的矢量:

    (4)

    聯(lián)立(1)、(2)、(4)式,寫成矩陣形式:

    (6)

    (8)

    受慣性傳感器本身測量偏差和外界干擾的影響,使得按(6)式求解的姿態(tài)矩陣不能嚴格滿足正交化要求[23],可以按下式進行正交化處理:

    1.2.2 雙矢量定姿粗對準

    1)雙矢量定姿原理

    雙矢量定姿是利用兩個不共線的矢量在直角坐標系系和系下的投影坐標,從而確定兩坐標系之間的方位關(guān)系[24-25]。不妨假設(shè)兩個不共線的矢量為和,它們在系和系下的投影坐標依次記為、、、,則系和系間方位關(guān)系可用方向余弦矩陣(姿態(tài)矩陣)來描述,通過引入輔助矢量并利用矢量坐標變換關(guān)系,不難得到:

    針對(10)式的一種改進思路是預(yù)先對參與解算的所有矢量作單位正交化處理。圖1給出了由測量矢量和構(gòu)造3個單位正交矢量、和的空間方位示意圖。圖1中,被選為主矢量,選擇主矢量的一般原則是選擇兩個矢量中的測量誤差較小者。

    2)雙矢量定姿粗對準

    (13)

    (15)

    于是式(12)、(13)分別改寫為:

    (17)

    進一步寫成:

    (19)

    (21)

    考慮到加速度計的測量誤差一般小于陀螺儀的測量誤差,文中選擇作為主參考矢量,參照式(11)可得姿態(tài)矩陣估計算法表達式:

    (22)

    將式(7)、(8)代入式(22),經(jīng)化簡后得到:

    實際對準過程中,為降低慣性傳感器高頻噪聲的影響,可以采集一段時間內(nèi)的傳感器數(shù)據(jù)求平均,然后用該時間段內(nèi)的平均角速度及平均加速度分別代替式(23)中的和,從而估算出初始姿態(tài)矩陣。

    估算出姿態(tài)矩陣后,不難解算出載體的姿態(tài)角。假設(shè)海參捕撈裝置的俯仰角、橫滾角和航向角分別用(°)、(°)和(°)表示,則姿態(tài)矩陣可寫成[26]:

    (24)

    由式(24),得:

    1.3 誤差分析

    從理論上分析不同對準方法的誤差特性,對于工程實踐中選擇更好的對準方案具有指導意義。傳統(tǒng)解析粗對準中,正交化后的姿態(tài)矩陣估計值消除了刻度系數(shù)誤差和歪斜誤差,但仍然含有漂移誤差,文獻[27]導出的漂移誤差失準角的估算式為:

    (27)

    (28)

    將式(29)按向量叉乘運算規(guī)則展開,忽略二階及以上小量,并記慣性傳感器的測量誤差和,得:

    為簡化書寫,式(30)中與誤差分析結(jié)果不相關(guān)的元素用“*”表示。

    (32)

    即有:

    可見,雙矢量定姿粗對準的水平失準角只受加速度計水平測量誤差、的影響,而傳統(tǒng)解析粗對準的水平失準角除跟加速度計測量誤差有關(guān)外,還和天向陀螺漂移誤差有關(guān),一般情況下,由于陀螺測量誤差遠大于加速度計測量誤差,因此,雙矢量定姿粗對準算法提高了水平對準精度。對比式(28)、(33)可知,兩者方位對準精度相當,且方位失準角主要取決于陀螺的東向漂移誤差。

    2 結(jié)果與分析

    為驗證上述2種粗對準算法的優(yōu)劣,試驗中使用瑞芬科技有限公司的AH106B型MEMS慣性測量單元和DCM260型三維電子羅盤的實測值進行對比試驗,實物如圖2所示。試驗條件:當?shù)鼐暥?40.004 9°;所用慣性測量單元的陀螺儀常值漂移20°/h,陀螺儀隨機游走系數(shù),加速度計零偏,陀螺儀和加速度計的最大數(shù)據(jù)輸出頻率300 Hz,試驗中陀螺儀和加速度計的數(shù)據(jù)采集周期均設(shè)置為20 ms;三維電子羅盤的傾角分辨率0.1°,數(shù)據(jù)輸出頻率20 Hz。海參捕撈裝置主要由導航模塊、推進器模塊、水下攝像機、捕撈機構(gòu)等構(gòu)成;其中,導航模塊安裝于海參捕撈裝置載體中部的封閉式平臺上。試驗地點選擇山東海陽某海參養(yǎng)殖場水域,與本試驗相關(guān)場景圖如圖3所示。數(shù)據(jù)采集試驗步驟如下:1)將慣性測量單元、三維電子羅盤固定于減振平臺上,并保證兩模塊的向軸線分別平行,然后將減振平臺靜置于海參捕撈裝置的載體上;2)同時采集并存儲慣性測量單元中陀螺儀和加速度計輸出的原始數(shù)據(jù)以及三維電子羅盤輸出的姿態(tài)角數(shù)據(jù);3)保持試驗系統(tǒng)靜止30 min后停止數(shù)據(jù)采集與記錄。

    選取慣性測量單元采集的同一原始試驗數(shù)據(jù),在Matlab平臺上,應(yīng)用前述的兩種粗對準算法分別進行粗對準解算,每次對準時間為1 min,共進行了30次對準試驗。圖4為傳統(tǒng)解析粗對準算法得到的捷聯(lián)慣導系統(tǒng)俯仰角、橫滾角和航向角的估算值,而雙矢量定姿粗對準算法得到的俯仰角、橫滾角和航向角的估算值如圖5所示。圖4、5的俯仰角和橫滾角代表載體的水平姿態(tài),而航向角代表載體的方位姿態(tài)。圖4的水平姿態(tài)角變化幅度大且呈現(xiàn)出明顯的振蕩特性,而圖5的水平姿態(tài)角變化幅度小且變化平穩(wěn);圖4和5的方位姿態(tài)角變化規(guī)律一致。

    圖4 傳統(tǒng)解析粗對準算法估算的姿態(tài)角

    圖5 雙矢量定姿粗對準算法估算的姿態(tài)角

    為進一步驗證粗對準算法效果,文中使用三維電子羅盤實測值作為算法評估的參考基準,試驗中所用三維電子羅盤的俯仰和橫滾精度為0.1°、航向精度為0.5°。為使數(shù)據(jù)比較有意義,安裝時,該電子羅盤的3個軸向與慣性測量單元模塊的對應(yīng)軸向平行且一致。在進行靜態(tài)數(shù)據(jù)采集的30 min內(nèi),三維電子羅盤輸出的俯仰角和橫滾角的數(shù)值穩(wěn)定,分別為–0.8°和–0.2°,而航向角做低頻小幅度變化,取其平均值為143.5°,將這3個實測值在圖4、5中標示成水平直線,以便與30次粗對準試驗的估算值作對比。將粗對準算法所得的姿態(tài)估算值減去對應(yīng)時刻三維電子羅盤實測的姿態(tài)值得到姿態(tài)誤差。表1給出30次粗對準試驗中2種粗對準算法對應(yīng)姿態(tài)誤差的試驗結(jié)果,其中“算法1”代表傳統(tǒng)解析粗對準算法,“算法2”代表雙矢量定姿粗對準算法,由于2種算法的方位對準的精度相當,表1中合并列出了航向角誤差??紤]到電子羅盤提供的參考基準精度僅為0.1°,表1中數(shù)值只保留一位有效數(shù)字。

    表1 粗對準姿態(tài)估算值與電子羅盤姿態(tài)測量值間的誤差

    從表1所列粗對準結(jié)果可見,傳統(tǒng)解析粗對準算法的俯仰角誤差和橫滾角誤差偏大且變化比較劇烈,而雙矢量定姿粗對準算法的水平誤差角的大小不超過1°,方位誤差角的大小不超過3°,方位誤差大于水平誤差,與前述誤差特性的理論分析結(jié)果相吻合。

    3 結(jié) 論

    1)所提出的雙矢量定姿粗對準算法預(yù)先對參與姿態(tài)解算的矢量作單位正交化處理,使得姿態(tài)矩陣估計值自然滿足正交化條件,有效降低了慣性傳感器測量誤差和外界干擾對粗對準精度的影響。

    2)理論分析和試驗結(jié)果都表明,所述算法提高了海參捕撈裝置捷聯(lián)慣導系統(tǒng)的水平對準精度。以三維電子羅盤實測值作為基準,所述粗對準算法的水平誤差角小于1°,方位誤差角小于3°,在粗對準所要求的誤差范圍之內(nèi),為后續(xù)利用濾波方法進行精對準提供了有效的初始條件。

    [1] 羅錫文,廖娟,鄒湘軍,等. 信息技術(shù)提升農(nóng)業(yè)機械化水平[J]. 農(nóng)業(yè)工程學報,2016,32(20):1-14. Luo Xiwen, Liao Juan, Zou Xiangjun, et al. Enhancing agricultural mechanization level through information technology[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2016, 32(20): 1-14. (in Chinese with English abstract)

    [2] 胡靜濤,高雷,白曉平,等. 農(nóng)業(yè)機械自動導航技術(shù)研究進展[J]. 農(nóng)業(yè)工程學報,2015,31(10):1-10. Hu Jingtao, Gao Lei, Bai Xiaoping, et al. Review of research on automatic guidance of agricultural vehicles[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2015, 31(10): 1-10. (in Chinese with English abstract)

    [3] 陳艷,張漫,馬文強,等. 基于GPS和機器視覺的組合導航定位方法[J]. 農(nóng)業(yè)工程學報,2011,27(3):126-130. Chen Yan, Zhang Man, Ma Wenqiang, et al. Positioning method of integrated navigation based on GPS and machine vision[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2011, 27(3): 126-130. (in Chinese with English abstract)

    [4] 趙德安,羅吉,孫月平,等. 河蟹養(yǎng)殖自動作業(yè)船導航控制系統(tǒng)設(shè)計與測試[J]. 農(nóng)業(yè)工程學報,2016,32(11):181-188. Zhao Dean, Luo Ji, Sun Yueping, et al. Design and experiment of navigation control system of automatic operation boat in river crab culture[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2016, 32(11): 181-188. (in Chinese with English abstract)

    [5] 洪劍青,趙德安,孫月平,等. 水產(chǎn)養(yǎng)殖自動導航無人明輪船航向的多模自適應(yīng)控制[J]. 農(nóng)業(yè)工程學報,2017,33(1):95-101. Hong Jianqing, Zhao Dean, Sun Yueping, et al. Multi model adaptive control of paddlewheel vehicle’s course in aquaculture[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2017, 33(1): 95-101. (in Chinese with English abstract)

    [6] 楊衛(wèi)中,徐銀麗,喬曦,等. 基于對比度受限直方圖均衡化的水下海參圖像增強方法[J]. 農(nóng)業(yè)工程學報,2016,32(6):197-203. Yang Weizhong, Xu Yinli, Qiao Xi, et al. Method for image intensification of underwater sea cucumber based on contrast-limited adaptive histogram equalization[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2016, 32(6): 197-203. (in Chinese with English abstract)

    [7] Guo Haizhi, Yu Fusheng, Zhao Yang, et al. Structure design of sea cucumber catching robot based on TRIZ theory[J]. Mechanical Engineering and Technology, 2016, 5(3): 227-237.

    [8] 謝鑫建,王麗. 水上操控管吸式海參捕撈裝置:2013106776810[P]. 2015-11-11. Xie Xinjian, Wang Li. Tube suction sea cucumber fishing device on water operation: 2013106776810[P]. 2015-11-11.

    [9] 馬秀芬. 吸入式海參捕撈器及捕撈方法:2014101574484[P]. 2015-10-28. Ma Xiufen. Suction sea cucumber fishing device and fishing method: 2014101574484[P]. 2015-10-28.

    [10] 岳鵬,史震,王劍,等. 基于MEMS加速度計的無陀螺慣導系統(tǒng)[J]. 中國慣性技術(shù)學報,2011,19(2):152-156. Yue Peng, Shi Zhen, Wang Jian, et al. Gyro free inertial navigation system based on MEMS accelerometer[J]. Journal of Chinese Inertial Technology, 2011, 19(2): 152-156. (in Chinese with English abstract)

    [11] Zhang Q Z, Meng X L, Zhang S B, et al. Singular value decomposition-based robust cubature Kalman filtering for an integrated GPS/SINS navigation system[J]. Journal of Navigation, 2015, 68(3): 549-562.

    [12] 劉軍,袁俊,蔡駿宇,等. 基于GPS/INS和線控轉(zhuǎn)向的農(nóng)業(yè)機械自動駕駛系統(tǒng)[J]. 農(nóng)業(yè)工程學報,2016,32(1):46-53. Liu Jun, Yuan Jun, Cai Junyu, et al. Autopilot system of agricultural vehicles based on GPS/INS and steer-by-wire[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2016, 32(1): 46-53. (in Chinese with English abstract)

    [13] 李博文,姚丹亞. 低成本車載MEMS慣導導航定位方法[J].中國慣性技術(shù)學報,2014,22(6):719-723. Li Bowen, Yao Danya. Low-cost MEMS IMU navigation positioning method for land vehicle[J]. Journal of Chinese Inertial Technology, 2014, 22(6): 719-723. (in Chinese with English abstract)

    [14] 嚴恭敏,翁浚,白亮,等. 基于慣性參考系的動基座初始對準與定位導航[J]. 系統(tǒng)工程與電子技術(shù),2011,33(3):618-621. Yan Gongmin, Weng Jun, Bai Liang, et al. Initial in-movement alignment and position determination based on inertial reference frame[J]. Systems Engineering and Electronics, 2011, 33(3): 618-621. (in Chinese with English abstract)

    [15] Du Tao, Guo Lei, Yang Jian. A fast initial alignment for SINS based on disturbance observer and Kalman filter[J]. Transactions of the Institute of Measurement and Control, 2016, 38(10): 1261-1269.

    [16] 趙長山,秦永元,白亮. 基于雙矢量定姿的搖擺基座粗對準算法分析與實驗[J]. 中國慣性技術(shù)學報,2009,17(4):436-440. Zhao Changshan, Qin Yongyuan, Bai Liang. Analysis and test of swaying-based analytic coarse alignment[J]. Journal of Chinese Inertial Technology, 2009, 17(4): 436-440. (in Chinese with English abstract)

    [17] 王躍鋼,蔚躍,雷堰龍,等. 捷聯(lián)慣導一種優(yōu)化的慣性系粗對準方法[J]. 科學技術(shù)與工程,2013,13(4):1102-1105. Wang Yuegang, Yu Yue, Lei Yanlong, et al. An improved method of inertial coordination coarse alignment in SINS[J]. Science Technology and Engineering, 2013, 13(4): 1102-1105. (in Chinese with English abstract)

    [18] 陳令剛,劉建業(yè),孫永榮,等. 微小型捷聯(lián)慣導系統(tǒng)解析式對準方法研究[J]. 航天控制,2005,23(4):9-12. Chen Linggang, Liu Jianye, Sun Yongrong, et al. Study of analytic coarse alignment methods to micro SINS [J]. Aerospace Control, 2005, 23(4): 9-12. (in Chinese with English abstract)

    [19] Weng J, Qin Y Y, Yan G M, et al. Analysis method on error distributions of in-flight alignment schemes [J]. Journal of Chinese Inertial Technology, 2015, 23(5): 570-574.

    [20] 于飛,翟國富,高偉,等. 艦船捷聯(lián)慣導系統(tǒng)粗對準方法研究[J]. 傳感器與微系統(tǒng),2009,28(5):15-18. Yu Fei, Zhai Guofu, Gao Wei, et al. Research on coarse alignment for vessel strapdown inertial navigation system[J]. Transducer and Microsystem Technologies, 2009, 28(5): 15-18. (in Chinese with English abstract)

    [21] 徐博,孫楓,高偉. 艦船捷聯(lián)航姿系統(tǒng)自主粗對準仿真與實驗研究[J]. 兵工學報,2008,29(12):1467-1473. Xu Bo, Sun Feng, Gao Wei. The coarse alignment of strap-down inertial navigation system for ship[J]. Acta Armamentarii, 2008, 29(12): 1467-1473. (in Chinese with English abstract)

    [22] Xiong J, Guo H, Yang Z H. A two-position SINS initial alignment method based on gyro information[J]. Advances in Space Research, 2014, 53(11): 1657-1663.

    [23] Liu M, Gao Y B, Li G C, et al. An improved alignment method for the strapdown inertial navigation system (SINS) [J]. Sensors, 2016, 16(5): 12-17.

    [24] 嚴恭敏,秦永元,衛(wèi)育新,等. 一種適用于SINS動基座初始對準的新算法[J]. 系統(tǒng)工程與電子技術(shù),2009,31(3):634-637. Yan Gongmin, Qin Yongyuan, Wei Yuxin, et al. New initial alignment algorithm for SINS on moving base[J]. Systems Engineering and Electronics, 2009, 31(3): 634-637. (in Chinese with English abstract)

    [25] Tan Caiming, Zhu Xinhua, Su Yan, et al. A new analytic alignment method for a SINS[J]. Sensors, 2015, 15(11): 27930-27953.

    [26] Chang L B, Li J S, Chen S Y. Initial alignment by attitude estimation for strapdown inertial navigation systems[J]. IEEE Transactions on Instrumentation and Measurement, 2015, 64(3): 784-794.

    [27] Yeon Fuh Jiang. Error analysis of analytic coarse alignment methods[J]. IEEE Transactions on Aerospace and Electronic Systems, 1998, 34(1): 334-337.

    [28] Li Q, Ben Y Y, Yang J L. Coarse alignment for fiber optic gyro SINS with external velocity aid[J]. OPTIK, 2014, 125(16): 4241-4245.

    [29] Silva F O, Hemerly E M, Filho W C L. Error analysis of analytical coarse alignment formulations for stationary SINS [J]. IEEE Transactions on Aerospace and Electronic Systems, 2016, 52(4): 1777-1796.

    [30] 薛海建,王解,郭曉松,等. SINS非線性自對準中的強跟蹤UKF算法設(shè)計[J]. 上海交通大學學報,2015,49(9):1429-1434. Xue Haijian, Wang Jie, Guo Xiaosong, et al. Design of a strong tracing UKF for nonlinear self-alignment of SINS[J]. Journal of Shanghai Jiao Tong University, 2015, 49(9): 1429-1434. (in Chinese with English abstract)

    Double-vector attitude determination algorithm improving coarse alignment accuracy of strapdown inertial navigation system for sea cucumber fishing device

    Bao Jianhua1,2,3, Qiao Xi1,3, Li Daoliang1,3※

    (1.100083,; 2.221116,; 3.100083,)

    Autonomous navigation is one of the key technologies for an intelligent agricultural equipment, which has been widely used in modern agricultural production. Sea cucumber production and consumption are very large in China. At present, the sea cucumber harvest mainly relies on trawl or artificial fishing, which will cause a potential hazard to the health of divers and the marine ecology. Therefore, in order to overcome the shortcomings of traditional sea cucumber fishing methods, it is necessary to develop a sea cucumber fishing device with autonomous navigation and positioning functions. Strapdown inertial navigation system (SINS) is suitable for the navigation of the autonomous sea cucumber fishing device because of its autonomy, passivity and complete navigation parameters. For the SINS, initial alignment must be completed before starting a navigation mission. The purpose of the initial alignment is to determine the initial position of the carrier coordinate system relative to the navigation coordinate system, that is, to determine the initial value of the attitude matrix. Initial alignment is one of the key technologies of SINS, which is divided into coarse alignment and fine alignment, and the coarse alignment accuracy will directly determine the performance of the initial alignment. Therefore, it is of practical value to study a coarse alignment scheme with simple algorithm and high alignment precision. The traditional analytical coarse alignment algorithm directly utilizes the earth gravity vector and the earth rotation angular velocity vector to estimate the initial attitude matrix. In view of the problem that the horizontal alignment accuracy of SINS is affected by the measurement errors of gyroscope and accelerometer in the traditional analytical coarse alignment algorithm, a novel coarse alignment algorithm based on double-vector attitude determination is proposed. In general, the measurement error of the accelerometer is much smaller than that of the gyroscope, so the earth gravity vector in the proposed algorithm is chosen as the main reference vector. Then, 3 unit orthogonal vectors are constructed based on the earth gravity vector and the earth rotation angular velocity vector, and the resulting attitude matrix is a unit orthogonal matrix. The theoretical analysis shows that horizontal misalignment angles of SINS are only related to the accelerometer level measurement errors in the case of using the proposed algorithm, however, using the conventional algorithm, the horizontal misalignment angles are related to the accelerometer measurement errors and the gyroscope drift error. Therefore, the coarse alignment accuracy of SINS using the aforementioned algorithm is significantly improved.Based on the same measured data from an inertial measurement unit, the simulation experiment was carried out for 30 times using the conventional coarse alignment algorithm and the proposed algorithm, respectively. Simulation curves demonstrated that the variation of the horizontal attitude angles using the algorithm proposed was smoother. To further verify the effectiveness of the algorithm, the attitude angles calculated from the measured values of the inertial measurement unit were compared with the measured value of a high-precision three-dimensional electronic compass, and the experimental results showed that the horizontal error angles of the aforementioned coarse alignment algorithm did not exceed 1° and the azimuth error angle did not exceed 3°. The results can meet the accuracy requirement of coarse alignment and will provide an effective initial condition for the subsequent fine alignment using filtering methods.

    fisheries; navigation; algorithms; strapdown inertial navigation; coarse alignment; double-vector attitude determination; stationary base; sea cucumber fishing

    10.11975/j.issn.1002-6819.2017.12.037

    TN966; TP391.9

    A

    1002-6819(2017)-12-0286-07

    2016-12-29

    2017-03-27

    國家國際科技合作專項項目(2013DFA11320);中央高校基本科研業(yè)務(wù)費專項資金資助項目(2016XD001)

    包建華,男,安徽肥東人,副教授,博士生,主要從事慣性導航及組合導航研究。北京 中國農(nóng)業(yè)大學信息與電氣工程學院,100083。 Email:baojhxz@cau.edu.cn

    李道亮,男,山東墾利人,教授,博士生導師,主要從事農(nóng)業(yè)信息先進感知與智能處理研究。北京 中國農(nóng)業(yè)大學信息與電氣工程學院,100083。Email:dliangl@cau.edu.cn

    包建華,喬 曦,李道亮. 雙矢量定姿算法提高海參捕撈裝置捷聯(lián)慣導系統(tǒng)粗對準精度[J]. 農(nóng)業(yè)工程學報,2017,33(12):286-292. doi:10.11975/j.issn.1002-6819.2017.12.037 http://www.tcsae.org

    Bao Jianhua,Qiao Xi,Li Daoliang. Double-vector attitude determination algorithm improving coarse alignment accuracy of strapdown inertial navigation system for sea cucumber fishing device[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2017, 33(12): 286-292. (in Chinese with English abstract) doi:10.11975/j.issn.1002-6819.2017.12.037 http://www.tcsae.org

    猜你喜歡
    捷聯(lián)慣導對準
    自適應(yīng)模糊多環(huán)控制在慣導平臺穩(wěn)定回路中的應(yīng)用
    對準提升組織力的聚焦點——陜西以組織振興引領(lǐng)鄉(xiāng)村振興
    當代陜西(2018年12期)2018-08-04 05:49:20
    無人機室內(nèi)視覺/慣導組合導航方法
    彈道導彈的捷聯(lián)慣性/天文組合導航方法
    一種改進的速度加姿態(tài)匹配快速傳遞對準算法
    基于Bagging模型的慣導系統(tǒng)誤差抑制方法
    捷聯(lián)慣性/天文/雷達高度表組合導航
    半捷聯(lián)雷達導引頭視線角速度提取
    INS/GPS組合系統(tǒng)初始滾轉(zhuǎn)角空中粗對準方法
    基于多線程的慣導邏輯仿真器設(shè)計
    計算機工程(2015年4期)2015-07-05 08:28:57
    精品久久久久久成人av| 变态另类丝袜制服| 一本久久精品| 高清毛片免费看| 国产成人午夜福利电影在线观看| 国产乱人视频| 天堂√8在线中文| 99久久无色码亚洲精品果冻| 午夜福利成人在线免费观看| 少妇熟女aⅴ在线视频| 国产av在哪里看| 国产国拍精品亚洲av在线观看| 18禁裸乳无遮挡免费网站照片| 99热这里只有是精品在线观看| 精品国内亚洲2022精品成人| 身体一侧抽搐| 亚洲18禁久久av| 一区二区三区四区激情视频 | 久久99精品国语久久久| 麻豆国产97在线/欧美| 久久午夜亚洲精品久久| 91精品国产九色| 在线播放无遮挡| 在线观看av片永久免费下载| 成人特级av手机在线观看| 在现免费观看毛片| 联通29元200g的流量卡| 91久久精品电影网| 欧美精品国产亚洲| 国产人妻一区二区三区在| 亚洲久久久久久中文字幕| 国产精品乱码一区二三区的特点| 日韩中字成人| 男女视频在线观看网站免费| 内地一区二区视频在线| 夫妻性生交免费视频一级片| 91麻豆精品激情在线观看国产| 夜夜爽天天搞| 直男gayav资源| 老熟妇乱子伦视频在线观看| 菩萨蛮人人尽说江南好唐韦庄 | 免费观看的影片在线观看| 亚洲图色成人| 夜夜看夜夜爽夜夜摸| 国内揄拍国产精品人妻在线| 嫩草影院入口| 观看免费一级毛片| 三级国产精品欧美在线观看| 国产黄a三级三级三级人| 亚洲av免费高清在线观看| 色尼玛亚洲综合影院| 亚洲成人av在线免费| 啦啦啦韩国在线观看视频| 国产熟女欧美一区二区| av免费在线看不卡| 欧美色视频一区免费| 成人美女网站在线观看视频| 欧美精品一区二区大全| 91久久精品国产一区二区三区| 简卡轻食公司| 日韩在线高清观看一区二区三区| 亚洲成人精品中文字幕电影| 亚洲av熟女| 国产91av在线免费观看| 中文亚洲av片在线观看爽| 高清日韩中文字幕在线| 欧美色视频一区免费| 99精品在免费线老司机午夜| 日韩av不卡免费在线播放| 国国产精品蜜臀av免费| 美女高潮的动态| 欧美日韩国产亚洲二区| 亚洲成人中文字幕在线播放| 嫩草影院入口| 午夜精品一区二区三区免费看| 欧美日韩一区二区视频在线观看视频在线 | 日韩三级伦理在线观看| 成年女人永久免费观看视频| 一边摸一边抽搐一进一小说| av在线老鸭窝| 成人亚洲欧美一区二区av| 国产精品av视频在线免费观看| 六月丁香七月| 欧美一级a爱片免费观看看| 精品一区二区三区人妻视频| 久久久精品94久久精品| 国产麻豆成人av免费视频| 成人欧美大片| 日本与韩国留学比较| 国产黄片视频在线免费观看| 简卡轻食公司| 特级一级黄色大片| 久久这里只有精品中国| 久久午夜亚洲精品久久| 国产精品不卡视频一区二区| 中文欧美无线码| 搡老妇女老女人老熟妇| 尤物成人国产欧美一区二区三区| 国内精品美女久久久久久| 哪里可以看免费的av片| 国产日本99.免费观看| 国产伦在线观看视频一区| 中文欧美无线码| 女人十人毛片免费观看3o分钟| 国产91av在线免费观看| 身体一侧抽搐| 欧美性感艳星| 亚洲不卡免费看| 欧美日韩综合久久久久久| 国产精品国产三级国产av玫瑰| 99久久精品国产国产毛片| 日韩大尺度精品在线看网址| 国产精品福利在线免费观看| 毛片一级片免费看久久久久| 黄色欧美视频在线观看| 村上凉子中文字幕在线| 午夜老司机福利剧场| 精品久久久噜噜| 国内少妇人妻偷人精品xxx网站| 激情 狠狠 欧美| 成人二区视频| 99视频精品全部免费 在线| 国产精品人妻久久久影院| 国产淫片久久久久久久久| 精品久久久久久久人妻蜜臀av| 久久欧美精品欧美久久欧美| 免费搜索国产男女视频| 成人一区二区视频在线观看| 亚洲自拍偷在线| 国产成人a∨麻豆精品| 国产色爽女视频免费观看| 国产免费一级a男人的天堂| 久久久久久国产a免费观看| 国产视频内射| 久久久久久久久久久免费av| 久久人人爽人人爽人人片va| 99热全是精品| 亚洲av二区三区四区| 我的女老师完整版在线观看| 少妇熟女欧美另类| 亚洲最大成人中文| 亚洲熟妇中文字幕五十中出| 免费看av在线观看网站| 人体艺术视频欧美日本| 九九热线精品视视频播放| 夜夜夜夜夜久久久久| 伦理电影大哥的女人| 亚洲精品色激情综合| 国产精品嫩草影院av在线观看| 精品久久久久久久人妻蜜臀av| 亚洲成人精品中文字幕电影| 99久久精品国产国产毛片| 小蜜桃在线观看免费完整版高清| 欧美日韩精品成人综合77777| videossex国产| 青春草视频在线免费观看| 国产三级中文精品| 亚洲婷婷狠狠爱综合网| 欧美变态另类bdsm刘玥| 精品一区二区免费观看| 人妻少妇偷人精品九色| 成人高潮视频无遮挡免费网站| 久久久久久久久大av| 亚洲欧美中文字幕日韩二区| 久久精品国产亚洲av涩爱 | 啦啦啦韩国在线观看视频| 国产三级在线视频| 禁无遮挡网站| 久久亚洲国产成人精品v| 男女下面进入的视频免费午夜| 禁无遮挡网站| 中文资源天堂在线| 在线免费观看的www视频| 亚洲国产色片| 三级经典国产精品| 亚洲最大成人av| 国产精品蜜桃在线观看 | 日日摸夜夜添夜夜爱| 观看免费一级毛片| 成人三级黄色视频| 久久久久网色| 国产白丝娇喘喷水9色精品| 国产精品人妻久久久影院| a级毛色黄片| 一个人看的www免费观看视频| 深夜精品福利| 中出人妻视频一区二区| 1000部很黄的大片| 性插视频无遮挡在线免费观看| 国产日韩欧美在线精品| 亚洲欧美日韩无卡精品| 给我免费播放毛片高清在线观看| 日韩,欧美,国产一区二区三区 | 久久久色成人| 亚洲欧美日韩东京热| 国产一区亚洲一区在线观看| 国产单亲对白刺激| 我的老师免费观看完整版| 一个人免费在线观看电影| 乱码一卡2卡4卡精品| 日产精品乱码卡一卡2卡三| 夜夜爽天天搞| av在线亚洲专区| 色综合亚洲欧美另类图片| 国产黄色视频一区二区在线观看 | avwww免费| 久久午夜亚洲精品久久| 国产黄片美女视频| 国产一区二区三区在线臀色熟女| 别揉我奶头 嗯啊视频| 22中文网久久字幕| 国模一区二区三区四区视频| 久久久久久久久久成人| 少妇的逼好多水| 精品日产1卡2卡| 成年女人看的毛片在线观看| 国产 一区精品| 一本久久中文字幕| 一个人看视频在线观看www免费| 久久久久久久久久黄片| 亚洲av不卡在线观看| 我的老师免费观看完整版| 一区二区三区四区激情视频 | 日本av手机在线免费观看| 国产大屁股一区二区在线视频| 2022亚洲国产成人精品| 99久国产av精品国产电影| 欧美日韩国产亚洲二区| 国产一区二区在线av高清观看| 国产精品久久电影中文字幕| 村上凉子中文字幕在线| 成人av在线播放网站| 国内精品一区二区在线观看| 99九九线精品视频在线观看视频| 黄色欧美视频在线观看| 亚洲av男天堂| 免费看av在线观看网站| 日韩一本色道免费dvd| 嫩草影院入口| 人妻制服诱惑在线中文字幕| 国产精品精品国产色婷婷| 真实男女啪啪啪动态图| 国产 一区精品| 午夜爱爱视频在线播放| 三级男女做爰猛烈吃奶摸视频| a级毛片a级免费在线| 久久久久久久久久久丰满| 亚洲精品乱码久久久久久按摩| 精品久久久久久久末码| 国内精品一区二区在线观看| 免费大片18禁| 人人妻人人看人人澡| 亚洲av男天堂| 亚洲国产精品久久男人天堂| av免费观看日本| 最近2019中文字幕mv第一页| 亚洲欧美精品自产自拍| 亚洲婷婷狠狠爱综合网| 少妇高潮的动态图| 亚洲av一区综合| 欧美最黄视频在线播放免费| av免费在线看不卡| 国产91av在线免费观看| 哪个播放器可以免费观看大片| 麻豆成人午夜福利视频| 久久精品91蜜桃| 亚洲国产精品成人综合色| 人人妻人人看人人澡| 黑人高潮一二区| 精品99又大又爽又粗少妇毛片| 神马国产精品三级电影在线观看| 亚洲欧美中文字幕日韩二区| 不卡一级毛片| 中国美女看黄片| 不卡视频在线观看欧美| 免费大片18禁| 国产伦理片在线播放av一区 | 午夜久久久久精精品| 国产精品无大码| 国产精品美女特级片免费视频播放器| 全区人妻精品视频| 欧美xxxx黑人xx丫x性爽| 熟妇人妻久久中文字幕3abv| 亚洲最大成人av| 联通29元200g的流量卡| 中文精品一卡2卡3卡4更新| 欧洲精品卡2卡3卡4卡5卡区| 少妇被粗大猛烈的视频| 亚洲欧美精品综合久久99| 日本免费一区二区三区高清不卡| 男人的好看免费观看在线视频| 国产精品国产高清国产av| 我要看日韩黄色一级片| 天堂av国产一区二区熟女人妻| 97超视频在线观看视频| 亚洲不卡免费看| 亚洲成人中文字幕在线播放| 一级av片app| 神马国产精品三级电影在线观看| 热99re8久久精品国产| 高清午夜精品一区二区三区 | 国产女主播在线喷水免费视频网站 | 免费观看a级毛片全部| 中文字幕精品亚洲无线码一区| 亚洲一区二区三区色噜噜| 一边摸一边抽搐一进一小说| 成人亚洲欧美一区二区av| 亚洲欧美日韩卡通动漫| 亚洲性久久影院| 九九热线精品视视频播放| 中文字幕久久专区| av免费在线看不卡| 最近最新中文字幕大全电影3| 欧美bdsm另类| 亚洲人成网站在线播| 深夜a级毛片| 国产日本99.免费观看| 天天躁夜夜躁狠狠久久av| 日韩亚洲欧美综合| 九九在线视频观看精品| 好男人视频免费观看在线| 国产成人freesex在线| av在线天堂中文字幕| 国产av麻豆久久久久久久| 亚洲一级一片aⅴ在线观看| 成熟少妇高潮喷水视频| www日本黄色视频网| 桃色一区二区三区在线观看| 免费看a级黄色片| 久久精品夜色国产| 男女啪啪激烈高潮av片| 最近2019中文字幕mv第一页| 男人舔奶头视频| 久久午夜亚洲精品久久| 1000部很黄的大片| 人妻少妇偷人精品九色| 亚洲激情五月婷婷啪啪| 中文字幕精品亚洲无线码一区| 一区二区三区高清视频在线| 一进一出抽搐动态| 日日啪夜夜撸| 99热全是精品| 久久99蜜桃精品久久| 麻豆乱淫一区二区| 日本五十路高清| 一级黄片播放器| 日本免费一区二区三区高清不卡| 热99re8久久精品国产| 中文字幕av成人在线电影| 国产老妇伦熟女老妇高清| 你懂的网址亚洲精品在线观看 | 国产色爽女视频免费观看| 久久久久久久久大av| 色尼玛亚洲综合影院| 搡女人真爽免费视频火全软件| 国产一级毛片在线| 欧美日韩精品成人综合77777| 嘟嘟电影网在线观看| 深夜a级毛片| 一级av片app| 成人三级黄色视频| 成人亚洲精品av一区二区| 亚洲精品成人久久久久久| 99久国产av精品| 精品人妻视频免费看| 欧美丝袜亚洲另类| 村上凉子中文字幕在线| 欧美成人精品欧美一级黄| 国产一区二区三区av在线 | 久久中文看片网| 真实男女啪啪啪动态图| 久久精品影院6| 精品国内亚洲2022精品成人| 九九热线精品视视频播放| 欧美变态另类bdsm刘玥| 99九九线精品视频在线观看视频| 亚洲无线观看免费| 日日干狠狠操夜夜爽| 人妻制服诱惑在线中文字幕| 性插视频无遮挡在线免费观看| 国产精品一区二区在线观看99 | 久久久久久伊人网av| 国产在视频线在精品| 国产私拍福利视频在线观看| 黄色欧美视频在线观看| 亚洲无线在线观看| 亚洲成av人片在线播放无| 一级二级三级毛片免费看| 精品人妻视频免费看| 色视频www国产| 久久国产乱子免费精品| 99热这里只有精品一区| av免费在线看不卡| 日韩大尺度精品在线看网址| 91久久精品国产一区二区三区| 欧美高清成人免费视频www| 噜噜噜噜噜久久久久久91| kizo精华| 狂野欧美激情性xxxx在线观看| 97超碰精品成人国产| 中文字幕熟女人妻在线| 搞女人的毛片| 嫩草影院入口| 不卡一级毛片| 午夜激情福利司机影院| 美女大奶头视频| 午夜精品国产一区二区电影 | 少妇熟女欧美另类| 精品人妻视频免费看| 校园春色视频在线观看| 99久久中文字幕三级久久日本| 国产色爽女视频免费观看| 波多野结衣高清作品| 啦啦啦观看免费观看视频高清| 精品久久久久久久久av| 国产精品不卡视频一区二区| 亚洲av熟女| av福利片在线观看| 久久久色成人| 99国产极品粉嫩在线观看| 婷婷色av中文字幕| 国产伦精品一区二区三区视频9| 又爽又黄a免费视频| 国产精品人妻久久久影院| 日韩一区二区视频免费看| 九九热线精品视视频播放| 亚洲性久久影院| 日日摸夜夜添夜夜爱| 日本成人三级电影网站| 国产老妇伦熟女老妇高清| 国产三级中文精品| 欧美成人免费av一区二区三区| 九九久久精品国产亚洲av麻豆| 丝袜喷水一区| 亚洲精品国产成人久久av| 91精品一卡2卡3卡4卡| 国产亚洲5aaaaa淫片| 如何舔出高潮| 在线免费观看的www视频| 可以在线观看毛片的网站| 我要看日韩黄色一级片| 成年版毛片免费区| 国产亚洲av嫩草精品影院| 欧美精品一区二区大全| 又爽又黄无遮挡网站| 搡女人真爽免费视频火全软件| 国产色爽女视频免费观看| 亚洲欧洲日产国产| 久久精品国产亚洲av涩爱 | 最后的刺客免费高清国语| 欧美三级亚洲精品| 久久人人爽人人片av| 国产真实伦视频高清在线观看| 中文字幕制服av| 色综合亚洲欧美另类图片| 精品久久久噜噜| 国产视频首页在线观看| 亚洲精品久久久久久婷婷小说 | 精品久久久久久久久久久久久| 国产高清视频在线观看网站| 中文资源天堂在线| 亚洲婷婷狠狠爱综合网| 欧美精品一区二区大全| 久久草成人影院| 久久婷婷人人爽人人干人人爱| av在线老鸭窝| 激情 狠狠 欧美| 色综合色国产| 午夜精品在线福利| 午夜福利在线在线| 亚洲不卡免费看| 久久精品影院6| 国产午夜精品论理片| 欧美激情在线99| 高清午夜精品一区二区三区 | 亚洲欧洲国产日韩| 成人美女网站在线观看视频| av在线天堂中文字幕| 亚洲av二区三区四区| 国产老妇伦熟女老妇高清| 2021天堂中文幕一二区在线观| 国产精品伦人一区二区| 日韩欧美三级三区| 久久久久久久亚洲中文字幕| 欧美性感艳星| 人体艺术视频欧美日本| 非洲黑人性xxxx精品又粗又长| 3wmmmm亚洲av在线观看| 黄色欧美视频在线观看| 日本免费a在线| 六月丁香七月| 欧美精品一区二区大全| 国产精品久久久久久久久免| 国产一区亚洲一区在线观看| 国产午夜精品论理片| videossex国产| 中文字幕av成人在线电影| 国产精品蜜桃在线观看 | 亚洲美女搞黄在线观看| 亚洲av成人av| 熟妇人妻久久中文字幕3abv| 男人的好看免费观看在线视频| 久久欧美精品欧美久久欧美| 亚洲图色成人| 九九热线精品视视频播放| 99久久九九国产精品国产免费| 久久国内精品自在自线图片| av在线观看视频网站免费| 蜜桃久久精品国产亚洲av| 少妇的逼好多水| 亚洲欧美日韩东京热| 日本欧美国产在线视频| 久久国产乱子免费精品| 成人美女网站在线观看视频| 天美传媒精品一区二区| 天堂中文最新版在线下载 | 国产三级中文精品| 中文字幕制服av| 亚洲av成人av| 国内精品一区二区在线观看| 99在线视频只有这里精品首页| 国产 一区精品| 亚洲av成人精品一区久久| 深爱激情五月婷婷| 久久精品91蜜桃| 亚洲一区高清亚洲精品| 亚洲一级一片aⅴ在线观看| 尾随美女入室| 日韩高清综合在线| 自拍偷自拍亚洲精品老妇| 亚洲国产精品国产精品| 中国国产av一级| 在线a可以看的网站| 热99re8久久精品国产| 99久久精品热视频| 看片在线看免费视频| av卡一久久| 大型黄色视频在线免费观看| 欧洲精品卡2卡3卡4卡5卡区| 久久久久久大精品| 黄色日韩在线| 麻豆乱淫一区二区| 国产精品国产三级国产av玫瑰| 亚洲性久久影院| 久久九九热精品免费| 深夜a级毛片| 国产色婷婷99| av视频在线观看入口| av在线蜜桃| 中文字幕免费在线视频6| 床上黄色一级片| 久久久久久久久久久免费av| 少妇人妻精品综合一区二区 | 国产精品伦人一区二区| 国产成人精品婷婷| 岛国毛片在线播放| 51国产日韩欧美| 久久久久久伊人网av| 91狼人影院| 男插女下体视频免费在线播放| 只有这里有精品99| 久久人妻av系列| 久久综合国产亚洲精品| 亚洲一区二区三区色噜噜| 老司机福利观看| 亚洲欧洲日产国产| 亚洲成人av在线免费| 麻豆av噜噜一区二区三区| 在线免费观看的www视频| 亚洲在久久综合| 亚洲欧美中文字幕日韩二区| 久久精品国产亚洲av香蕉五月| 在线国产一区二区在线| 日韩高清综合在线| 亚洲国产精品sss在线观看| 精品久久久噜噜| 卡戴珊不雅视频在线播放| 波多野结衣高清无吗| 国产综合懂色| 国产黄色小视频在线观看| 两个人的视频大全免费| 国产91av在线免费观看| 噜噜噜噜噜久久久久久91| 亚洲电影在线观看av| 女的被弄到高潮叫床怎么办| a级毛片免费高清观看在线播放| .国产精品久久| 国产亚洲欧美98| 国产高清视频在线观看网站| 成年版毛片免费区| 久久精品国产亚洲网站| 亚洲18禁久久av| 三级经典国产精品| 99热这里只有是精品在线观看| 精品午夜福利在线看| 黄色配什么色好看| 一级黄片播放器| 国产高清视频在线观看网站| 国产白丝娇喘喷水9色精品| 国产视频内射| 哪里可以看免费的av片| 一级黄色大片毛片| 亚洲一区高清亚洲精品| 国产成人福利小说| 一级黄色大片毛片| 中文字幕人妻熟人妻熟丝袜美| 免费观看人在逋| 久久热精品热| 国产综合懂色| 欧美激情在线99| 最好的美女福利视频网| 免费人成在线观看视频色| 嫩草影院入口| 亚洲国产精品sss在线观看| 成人午夜精彩视频在线观看|