日韩精品一区二区三区在线视频放-无码中文字幕V?一区二区-成年片免费观看视频-国内少妇人妻丰满av-国产精品中文字幕免费观看-亚洲成人久久一区二区三区-国内少妇偷人精品视频无缓冲-一区二区国产精品日本一区二区三区在线网

ARTICLE DETAIL

資訊詳情

深耕商務(wù)建站與企業(yè)官網(wǎng)運(yùn)營(yíng)的一線實(shí)戰(zhàn)洞察。

MAVLink協(xié)議收發(fā)源碼實(shí)戰(zhàn):幀結(jié)構(gòu)、CRC校驗(yàn)與聯(lián)調(diào)經(jīng)驗(yàn)

MAVLink協(xié)議收發(fā)源碼實(shí)戰(zhàn):幀結(jié)構(gòu)、CRC校驗(yàn)與聯(lián)調(diào)經(jīng)驗(yàn) 簡(jiǎn)介MAVLink協(xié)議收發(fā)源碼是一套基于C的輕量級(jí)通信協(xié)議實(shí)現(xiàn)面向無(wú)人機(jī)、機(jī)器人控制及地面站開發(fā)者重點(diǎn)解決設(shè)備之間數(shù)據(jù)高效編解碼與串口透?jìng)鲉栴}。壓縮包共663個(gè)文件以606個(gè)h頭文件為主體涵蓋MAVLink標(biāo)準(zhǔn)協(xié)議定義、消息類型與編解碼接口另有cpp示例、vcxproj/sln工程配置和可執(zhí)行demo等整體約57.69MB。目前已有2374人學(xué)習(xí)瀏覽。資料中的demo示例演示了從串口初始化、構(gòu)造消息、字節(jié)流序列化到接收解析與CRC校驗(yàn)的完整收發(fā)流程調(diào)用mavlink_msg_to_send_buffer和mavlink_parse_char即可快速搭建通信鏈路進(jìn)而按消息ID處理GPS坐標(biāo)、傳感器讀數(shù)等數(shù)據(jù)。對(duì)于需要自主實(shí)現(xiàn)飛控/地面站通信模塊或深入閱讀MAVLink協(xié)議的C開發(fā)者來說這是一份貼近工程實(shí)踐的參考源碼。 做嵌入式或者無(wú)人機(jī)開發(fā)的朋友大概率都繞不開一個(gè)詞mavlink協(xié)議收發(fā)源碼。不管是給飛控寫機(jī)載計(jì)算機(jī)的通信程序還是自己搭一套地面站又或者只是想在STM32上報(bào)個(gè)姿態(tài)數(shù)據(jù)最終都會(huì)落到“怎么把MAVLink消息正確發(fā)出去、再把對(duì)方的消息收進(jìn)來并解析對(duì)”這個(gè)底層問題上。這篇我就把實(shí)際項(xiàng)目中調(diào)通MAVLink協(xié)議收發(fā)的完整經(jīng)驗(yàn)拆開講從幀結(jié)構(gòu)、CRC校驗(yàn)到收發(fā)代碼怎么組織再到聯(lián)調(diào)現(xiàn)場(chǎng)踩過的那些坑一次說透。適合正在搞飛控二次開發(fā)、打算自己寫通信模塊、或者被協(xié)議棧源碼搞得頭大的朋友直接參考。1. 為什么無(wú)人機(jī)通信離不開MAVLink1.1 從一根串口的血案說起先說一個(gè)我早年間遇到的真實(shí)場(chǎng)景。當(dāng)時(shí)做一個(gè)基于Pixhawk的植保無(wú)人機(jī)項(xiàng)目機(jī)載電腦需要實(shí)時(shí)讀取飛控的姿態(tài)和GPS數(shù)據(jù)同時(shí)要能下發(fā)航線任務(wù)。最開始圖省事直接按照飛控官方文檔里某個(gè)帖子的格式自己定義了一套串口報(bào)文幀頭用0xAA第二個(gè)字節(jié)是長(zhǎng)度后面跟著數(shù)據(jù)最后來一個(gè)累加和。結(jié)果一上真機(jī)就出問題。地面站軟件Mission Planner能正常連飛控我的程序卻經(jīng)常解析出亂碼偶爾出來一個(gè)正確姿態(tài)值下一幀又是錯(cuò)的。排查了整整兩天才意識(shí)到飛控默認(rèn)往外吐的是MAVLink而不是我自定義的格式而且Port速率、協(xié)議版本這些都會(huì)影響實(shí)際收到的字節(jié)流。說白了我是在和一個(gè)我根本不了解的協(xié)議較勁。后來老老實(shí)實(shí)把MAVLink的協(xié)議規(guī)范看了一遍才發(fā)現(xiàn)這個(gè)協(xié)議之所以能成為無(wú)人機(jī)領(lǐng)域的事實(shí)標(biāo)準(zhǔn)不是沒有理由的。MAVLink全稱Micro Air Vehicle Link最初就是為微型飛行器設(shè)計(jì)的點(diǎn)對(duì)點(diǎn)通信協(xié)議現(xiàn)在已經(jīng)被ArduPilot、PX4、QGroundControl、Mission Planner這些主流軟硬件廣泛采用。它的設(shè)計(jì)目標(biāo)很直接在帶寬受限的串口鏈路上把飛控的各種消息心跳、姿態(tài)、GPS、遙測(cè)、命令可靠地打包傳輸。1.2 MAVLink的設(shè)計(jì)哲學(xué)工具鏈生態(tài)是第一生產(chǎn)力很多初學(xué)者不理解為什么放著簡(jiǎn)單的自定義協(xié)議不用非得用一個(gè)看起來規(guī)則繁瑣的MAVLink。我的理解是它解決的根本不是“能不能傳數(shù)據(jù)”的問題而是“整個(gè)生態(tài)怎么高效協(xié)作”的問題。MAVLink定義了一整套標(biāo)準(zhǔn)消息集HEARTBEAT心跳、ATTITUDE姿態(tài)、GPS_RAW_INTGPS原始數(shù)據(jù)、MISSION_ITEM任務(wù)點(diǎn)等等。這意味著你寫的地面站不需要知道飛控是PX4還是ArduPilot只要雙方都遵循MAVLink規(guī)范就能互相理解。更關(guān)鍵的是它配套了完整的工具鏈xml消息定義文件、代碼生成器mavgen、各語(yǔ)言庫(kù)C/C、Python等。你改一個(gè)xml就能自動(dòng)生成對(duì)應(yīng)語(yǔ)言的收發(fā)代碼不需要手動(dòng)維護(hù)一套龐大的消息結(jié)構(gòu)體。這種“協(xié)議規(guī)范代碼生成生態(tài)工具”三位一體的思路是MAVLink最值錢的地方。所以當(dāng)你決定寫一個(gè)mavlink協(xié)議收發(fā)源碼時(shí)本質(zhì)上不是從零發(fā)明協(xié)議而是把這條生態(tài)鏈路接入到自己的項(xiàng)目里。2. 幀格式與CRC_EXTRA收發(fā)源碼的兩個(gè)硬門檻2.1 幀結(jié)構(gòu)逐字節(jié)拆解要寫收發(fā)代碼第一關(guān)就是把幀格式吃透。很多網(wǎng)上流傳的源碼寫得不清楚就是因?yàn)樵趲袷降睦斫馍贤盗藨?。MAVLink目前有兩個(gè)大版本v1和v2實(shí)際項(xiàng)目中遇到的基本都是v2但v1的老設(shè)備也還在服役收發(fā)代碼最好能兼容兩者。MAVLink v2的一幀數(shù)據(jù)長(zhǎng)這樣字節(jié)位置字段名長(zhǎng)度說明0STX1幀起始標(biāo)志固定為0xFD1LEN1負(fù)載長(zhǎng)度0~2552INC_FLAGS1不兼容標(biāo)志必須為0否則接收方可能拒絕3CMP_FLAGS1兼容標(biāo)志通常為04SEQ1消息序列號(hào)用于丟包檢測(cè)5SYS_ID1系統(tǒng)ID區(qū)分不同飛行器/地面站6COMP_ID1組件ID區(qū)分同一系統(tǒng)內(nèi)的不同模塊7~9MSG_ID3消息ID小端序排列10~PAYLOAD0~255消息負(fù)載末尾-2CKA1校驗(yàn)和高字節(jié)末尾-1CKB1校驗(yàn)和低字節(jié)v1的幀則簡(jiǎn)單一些沒有INC_FLAGS和CMP_FLAGSMSG_ID只有1字節(jié)起始標(biāo)志是0xFE。收發(fā)程序里解析幀頭時(shí)要先根據(jù)STX判斷是哪個(gè)版本再按對(duì)應(yīng)的格式讀取。這里有一個(gè)特別容易踩的細(xì)節(jié)MSG_ID在v2里是3字節(jié)而且是小端序。比如消息ID 0x000100在幀里出現(xiàn)的是00 01 00不是00 00 01。很多自研源碼收不到消息問題就出在這個(gè)字節(jié)序上。2.2 CRC_EXTRA協(xié)議給收發(fā)雙方設(shè)的暗號(hào)幀格式里有CRC校驗(yàn)這本身不稀奇。但MAVLink特殊的地方在于在計(jì)算CRC的時(shí)候除了幀里的字段和負(fù)載還要額外疊加一個(gè)叫CRC_EXTRA的種子字節(jié)。這個(gè)字節(jié)由消息ID和消息定義共同決定每條消息都不一樣。為什么這么設(shè)計(jì)你可以把CRC_EXTRA理解成“收發(fā)雙方約定的暗號(hào)”。它保證了發(fā)送方和接收方必須對(duì)消息定義各個(gè)字段的類型、長(zhǎng)度、排列順序保持一致。如果有一方用的協(xié)議版本或者消息定義和另一方對(duì)不上即使幀格式完全正確算出來的CRC也一定不一致接收方就會(huì)丟掉這幀。這比普通的CRC校驗(yàn)更能防止“能解析但解析錯(cuò)”的隱性bug。CRC_EXTRA不是一個(gè)固定值它由MAVLink的代碼生成器在生成頭文件時(shí)計(jì)算好。如果你用的是官方生成的C/C庫(kù)這個(gè)值已經(jīng)包含在一個(gè)靜態(tài)數(shù)組里了如果你自己寫解析源碼就需要從生成的代碼或者pymavlink庫(kù)里把對(duì)應(yīng)消息的CRC_EXTRA摳出來。這個(gè)值的具體算法是先把消息定義按規(guī)則序列化對(duì)每個(gè)字段做一次CRC更新X.25算法初始0xFFFF多項(xiàng)式0x1021最終得到一個(gè)字節(jié)。這個(gè)算法本身不復(fù)雜但沒有必要自己重新實(shí)現(xiàn)直接用官方工具生成的表就行。我在實(shí)際代碼里是直接把CRC_EXTRA數(shù)組定義成了常量表和消息ID一一對(duì)應(yīng)。2.3 字節(jié)序、消息ID寬度與會(huì)話簽名的邊界情況收發(fā)了多輪MAVLink之后我整理出幾個(gè)幀級(jí)細(xì)節(jié)新手特別容易栽進(jìn)去第一除了MSG_ID其余多字節(jié)字段也是小端序。比如GPS_RAW_INT中的緯度、經(jīng)度都是int32在負(fù)載里的字節(jié)序是低字節(jié)在前解析時(shí)如果用memcpy直接轉(zhuǎn)結(jié)構(gòu)體在沒有做字節(jié)序處理的平臺(tái)或者做跨平臺(tái)移植時(shí)會(huì)出現(xiàn)數(shù)值完全對(duì)不上的現(xiàn)象。第二v2幀的INC_FLAGS如果不為0接收方可能要檢查簽名。MAVLink v2支持一套基于密鑰的簽名機(jī)制在INC_FLAGS的第0位置1時(shí)幀尾會(huì)額外追加13字節(jié)的簽名信息。自研收發(fā)代碼時(shí)如果不想處理簽名接收端可以直接把帶簽名的幀丟棄或者設(shè)置兼容標(biāo)志讓發(fā)送方不啟用簽名。更省事的做法是自己組包時(shí)INC_FLAGS永遠(yuǎn)置0不給自己找麻煩。第三SEQ序列號(hào)是用來檢測(cè)丟包和幀亂序的。發(fā)送端每發(fā)一幀就自增10~255循環(huán)接收端可以通過相鄰兩幀SEQ的差值判斷中間是否丟幀。如果做數(shù)據(jù)鏈路層質(zhì)量評(píng)估這個(gè)字段是免費(fèi)的統(tǒng)計(jì)素材。3. 收發(fā)實(shí)現(xiàn)的三條路線怎么選不后悔3.1 官方C庫(kù)完整但厚重寫mavlink協(xié)議收發(fā)源碼最常見的方案是直接用官方C語(yǔ)言庫(kù)。從GitHub上拉取c_library_v2里面按消息集分了目錄直接把需要的那幾個(gè)頭文件拷進(jìn)項(xiàng)目調(diào)用mavlink_msg_heartbeat_pack、mavlink_msg_heartbeat_decode這類函數(shù)就能完成收發(fā)。這個(gè)方案的優(yōu)點(diǎn)是不用自己維護(hù)消息結(jié)構(gòu)體和CRC表支持所有消息天然適配v2和簽名機(jī)制。缺點(diǎn)也很明顯代碼體積巨大動(dòng)輒幾千行對(duì)MCU的Flash和RAM都有壓力另一個(gè)問題是封裝的層次太多出了問題不好排查。比如我曾在某個(gè)國(guó)產(chǎn)MCU上遇到CRC總是算不對(duì)最后發(fā)現(xiàn)是編譯器默認(rèn)的char類型是無(wú)符號(hào)還是帶符號(hào)影響了移位運(yùn)算的結(jié)果這種問題在官方庫(kù)里排查起來非常繞。所以官方C庫(kù)適合兩種場(chǎng)景一是跑在資源充足的機(jī)載電腦上二是需要全量消息支持的完整系統(tǒng)。如果只是某個(gè)資源緊巴巴的STM32項(xiàng)目用它可能有點(diǎn)殺雞用牛刀。3.2 pymavlink調(diào)試和仿真階段的最佳輔助pymavlink是MAVLink生態(tài)里最靈活的Python庫(kù)。它既能作為地面站的通信后端也能當(dāng)作調(diào)試工具來用。我經(jīng)常在串口調(diào)試階段直接用pymavlink寫個(gè)小腳本往飛控發(fā)一條命令看飛控返回什么驗(yàn)證我的自研收發(fā)源碼是不是真的把幀發(fā)對(duì)了。比如下面這段代碼就是典型的pymavlink姿勢(shì)from pymavlink import mavutil master mavutil.mavlink_connection(COM7, baud57600) master.wait_heartbeat() print(收到心跳系統(tǒng)ID:, master.target_system) # 請(qǐng)求飛控發(fā)送姿態(tài)數(shù)據(jù) master.mav.command_long_send( master.target_system, master.target_component, mavutil.mavlink.MAV_CMD_SET_MESSAGE_INTERVAL, 0, mavutil.mavlink.MAVLINK_MSG_ID_ATTITUDE, 200000, 0, 0, 0, 0, 0 ) while True: msg master.recv_match(typeATTITUDE, blockingTrue) print(msg.roll, msg.pitch, msg.yaw)pymavlink的價(jià)值在于它把MAVLink的編解碼、CRC_EXTRA計(jì)算、消息定義全部封裝好了你可以用它來生成參考數(shù)據(jù)再拿這些數(shù)據(jù)去驗(yàn)證自己的C代碼。比如抓一幀pymavlink發(fā)出的原始字節(jié)對(duì)比自己的封幀函數(shù)輸出很快就能定位是幀頭錯(cuò)了、長(zhǎng)度錯(cuò)了還是CRC算錯(cuò)了。3.3 自研精簡(jiǎn)版資源受限MCU的真正解法如果你的目標(biāo)平臺(tái)Flash只有64KBRAM只有16KB或者你和我一樣需要在一個(gè)特殊的國(guó)產(chǎn)芯片上跑MAVLink那自研一套精簡(jiǎn)收發(fā)源碼就是繞不開的路。這個(gè)“自研”不是完全從零手寫所有消息而是只保留你需要的消息子集比如心跳、姿態(tài)、GPS可能再加一兩個(gè)命令控制消息然后用自己的代碼實(shí)現(xiàn)幀組幀解析和CRC校驗(yàn)。自研代碼的核心工程量有三個(gè)部分幀結(jié)構(gòu)定義、CRC計(jì)算含CRC_EXTRA表、收發(fā)狀態(tài)機(jī)。下面一節(jié)我就把這部分的代碼邏輯完整拆開。4. 自研MAVLink收發(fā)器的核心源碼拆解4.1 幀結(jié)構(gòu)體與CRC_EXTRA表先把基礎(chǔ)的數(shù)據(jù)結(jié)構(gòu)定義好。我的做法是直接把幀頭和負(fù)載放連續(xù)緩沖區(qū)里構(gòu)造這樣算CRC和發(fā)送都非常方便。以下是一份以STM32為背景、但移植性很強(qiáng)的C語(yǔ)言實(shí)現(xiàn)骨架。#define MAVLINK_STX_V2 0xFD #define MAVLINK_STX_V1 0xFE #define MAVLINK_IFLAG_SIGNED 0x01 typedef struct { uint8_t stx; uint8_t len; uint8_t inc_flags; uint8_t cmp_flags; uint8_t seq; uint8_t sysid; uint8_t compid; uint32_t msgid; // 實(shí)際占3字節(jié)小端 uint8_t payload[255]; uint8_t cka; uint8_t ckb; } mavlink_frame_t;接收時(shí)我傾向于先把整幀收進(jìn)一個(gè)緩沖區(qū)校驗(yàn)通過后再解析而不是邊收邊解析。這樣邏輯清晰也方便處理半幀和粘幀的情況。CRC_EXTRA表直接從官方生成的頭文件里抄過來只保留會(huì)用到的消息。例如static const uint8_t mavlink_crc_extra[] { [0] 50, // HEARTBEAT [30] 39, // ATTITUDE [24] 23, // GPS_RAW_INT [74] 103, // VFR_HUD // ... };注意不同版本的消息ID相同但CRC_EXTRA不一定相同最好從和你實(shí)際使用的協(xié)議版本配套的生成文件里提取不要拿網(wǎng)上隨意找的老表直接套用。我在一個(gè)舊項(xiàng)目里就吃過這個(gè)虧表是1.0版本的協(xié)議棧是2.0結(jié)果所有消息校驗(yàn)不過排查了很久才發(fā)現(xiàn)是版本錯(cuò)配。4.2 發(fā)送鏈路封幀、組包、算校驗(yàn)發(fā)送一條消息邏輯上就是把負(fù)載塞到幀里、填好幀頭、算出CRC然后從串口打出去。以發(fā)送心跳消息為例HEARTBEAT的負(fù)載是7個(gè)字節(jié)type(1)、autopilot(1)、base_mode(1)、custom_mode(4)、system_status(1)、mavlink_version(1)。void mavlink_send_heartbeat(uint8_t sysid, uint8_t compid, uint8_t seq) { uint8_t buf[MAVLINK_MAX_FRAME_LEN]; uint16_t crc 0xFFFF; uint8_t payload[7]; payload[0] MAV_TYPE_QUADROTOR; // type payload[1] MAV_AUTOPILOT_ARDUPILOTMEGA; // autopilot payload[2] 0; // base_mode payload[3] 0; // custom_mode low byte payload[4] 0; payload[5] 0; payload[6] 0; // custom_mode high byte payload[7] MAV_STATE_ACTIVE; // system_status payload[8] 3; // mavlink_version // 幀頭 buf[0] MAVLINK_STX_V2; buf[1] sizeof(payload); buf[2] 0; // inc_flags buf[3] 0; // cmp_flags buf[4] seq; buf[5] sysid; buf[6] compid; buf[7] 0x00; // msgid low buf[8] 0x00; // msgid mid buf[9] 0x00; // msgid high memcpy(buf[10], payload, sizeof(payload)); // CRC計(jì)算從LEN字段開始到負(fù)載結(jié)束再追加CRC_EXTRA crc crc_calculate(buf[1], 9 sizeof(payload)); crc crc_accumulate(mavlink_crc_extra[MAVLINK_MSG_ID_HEARTBEAT], crc); buf[10 sizeof(payload)] (crc 8) 0xFF; buf[11 sizeof(payload)] crc 0xFF; uart_send(buf, 12 sizeof(payload)); }CRC算法是X.25初值0xFFFF多項(xiàng)式0x1021實(shí)現(xiàn)代碼網(wǎng)上很多但有一點(diǎn)必須強(qiáng)調(diào)CRC計(jì)算的起點(diǎn)是LEN字段不包括STX。這是MAVLink規(guī)范和普通幀校驗(yàn)不一樣的地方很多自己寫的源碼發(fā)出去的幀接收方總是回NACK原因往往就在這里。4.3 接收鏈路串口中斷DMA與狀態(tài)機(jī)解析接收端是mavlink協(xié)議收發(fā)源碼里最容易出bug的部分。我的建議是串口中斷或者DMA只負(fù)責(zé)把原始字節(jié)塞進(jìn)環(huán)形緩沖區(qū)絕對(duì)不要在中斷里做CRC計(jì)算或者消息解析主循環(huán)里統(tǒng)一做狀態(tài)機(jī)解析這樣能避免中斷嵌套導(dǎo)致的狀態(tài)錯(cuò)亂。解析狀態(tài)機(jī)可以用一個(gè)簡(jiǎn)單的枚舉來描述typedef enum { PARSE_STX, PARSE_LEN, PARSE_REST_HEADER, PARSE_PAYLOAD, PARSE_CRC } parse_state_t;核心邏輯是一個(gè)逐字節(jié)的switch-case循環(huán)。每來一個(gè)字節(jié)當(dāng)前狀態(tài)決定怎么處理在PARSE_STX狀態(tài)遇到0xFD就判定為v2幀并進(jìn)入PARSE_LEN遇到0xFE則按v1處理如果是其他字節(jié)說明鏈路里可能有噪聲繼續(xù)等待。在PARSE_LEN狀態(tài)記錄負(fù)載長(zhǎng)度。如果負(fù)載長(zhǎng)度超過預(yù)設(shè)最大值比如255說明幀頭可能錯(cuò)亂直接回到PARSE_STX重新同步。在PARSE_REST_HEADER狀態(tài)把剩余幀頭字段讀齊。這里要注意v2的MSG_ID是3字節(jié)要按小端拼成一個(gè)uint32。在PARSE_PAYLOAD狀態(tài)收滿len個(gè)負(fù)載字節(jié)后進(jìn)入PARSE_CRC。在PARSE_CRC狀態(tài)收齊2字節(jié)校驗(yàn)碼對(duì)整個(gè)幀從LEN開始計(jì)算CRC并與收到的校驗(yàn)碼比對(duì)相同則投遞到消息處理隊(duì)列然后無(wú)論結(jié)果如何都回到PARSE_STX。int mavlink_parse_byte(uint8_t c, mavlink_frame_t *frame, parse_state_t *state, uint8_t *payload_buf, uint16_t *payload_idx) { switch (*state) { case PARSE_STX: if (c MAVLINK_STX_V2) { frame-stx c; *state PARSE_LEN; } else if (c MAVLINK_STX_V1) { // v1處理len在第二個(gè)字節(jié)沒有inc/cmp frame-stx c; *state PARSE_LEN; } // 忽略其他雜散字節(jié)保持同步等待 break; case PARSE_LEN: frame-len c; if (frame-len 255) { *state PARSE_STX; // 長(zhǎng)度異常重新同步 return -1; } *payload_idx 0; *state PARSE_REST_HEADER; break; case PARSE_REST_HEADER: // 按幀格式依次讀取后續(xù)字段v1與v2路徑不同 // 這里以v2為例 // ... break; case PARSE_PAYLOAD: payload_buf[(*payload_idx)] c; if (*payload_idx frame-len) { *state PARSE_CRC; } break; case PARSE_CRC: // 收齊兩個(gè)校驗(yàn)字節(jié)后做完整校驗(yàn) // ... break; } return 0; }這里有一個(gè)實(shí)操經(jīng)驗(yàn)接收緩沖區(qū)至少要能存放2倍最大幀長(zhǎng)否則高波特率下主循環(huán)處理不過來環(huán)形緩沖會(huì)互相覆蓋。比如波特率921600一幀最長(zhǎng)280字節(jié)左右緩沖區(qū)建議直接上512字節(jié)或更大。另一個(gè)經(jīng)驗(yàn)是如果鏈路噪聲比較嚴(yán)重會(huì)出現(xiàn)大量解析失敗的分組此時(shí)不要簡(jiǎn)單地丟棄就算了最好在調(diào)試階段把丟掉的幀字節(jié)數(shù)通過調(diào)試串口打出來幫助判斷是物理層的問題還是協(xié)議層的問題。5. 聯(lián)調(diào)實(shí)錄三個(gè)典型故障的完整排查鏈路5.1 地面站收不到心跳緩沖區(qū)管理問題現(xiàn)象很典型自研飛控板連接QGroundControl地面站一直提示“no heartbeat received”但用串口助手看飛控的TX引腳數(shù)據(jù)明明在往外吐。排查鏈路我先從物理層開始用示波器看TX波形確認(rèn)波特率沒有配置錯(cuò)也排除了TTL電平和RS232電平不匹配的干擾。接著用邏輯分析儀直接抓串口數(shù)據(jù)發(fā)現(xiàn)飛控發(fā)的第一幀看起來是0xFD開頭這是對(duì)的。再把抓到的二進(jìn)制流導(dǎo)出用pymavlink的解析腳本去解析結(jié)果顯示CRC錯(cuò)誤。這就很奇怪了因?yàn)閹^幀尾初始都正常CRC怎么會(huì)錯(cuò)后來我把目光放到環(huán)形緩沖區(qū)上才發(fā)現(xiàn)問題接收側(cè)DMA沒有開啟半傳輸中斷當(dāng)緩沖區(qū)寫指針超過頂端后數(shù)據(jù)會(huì)覆蓋未讀的數(shù)據(jù)。在高負(fù)載時(shí)覆蓋發(fā)生在主循環(huán)還沒來得及取出數(shù)據(jù)的時(shí)候等主循環(huán)去取時(shí)讀到的是被篡改過的幀自然CRC不過。修復(fù)方案是把環(huán)形緩沖區(qū)的讀指針和寫指針都做原子操作保護(hù)并且給DMA開半傳輸中斷和傳輸完成中斷保證在緩沖區(qū)滿之前就把數(shù)據(jù)搬運(yùn)出去。改完后再跑心跳穩(wěn)定輸出問題解決。5.2 CRC校驗(yàn)狂失敗EXTRA表錯(cuò)位問題另一個(gè)項(xiàng)目里接收pymavlink發(fā)來的命令我的自研代碼幾乎一條命令都解析不了每條都在CRC校驗(yàn)階段被丟棄。最開始懷疑是時(shí)序問題把波特率從57600降到9600也沒用。后來我在代碼里加了一個(gè)調(diào)試信息打印出收到的CRC和本地算出的CRC。一對(duì)照發(fā)現(xiàn)收到的CRC總是變而本地算出的CRC總是和官方庫(kù)不一樣差值不固定說明問題不是簡(jiǎn)單的常數(shù)偏移。這時(shí)我想到了CRC_EXTRA表如果表的索引和消息ID不對(duì)應(yīng)算出來的CRC會(huì)隨機(jī)地時(shí)而正確、時(shí)而錯(cuò)誤因?yàn)椴煌⒌腃RC_EXTRA值各不相同。進(jìn)一步檢查果然發(fā)現(xiàn)我的CRC_EXTRA數(shù)組是從網(wǎng)絡(luò)上一篇老文章里復(fù)制的里面按照v1時(shí)代的消息索引排的序。v2的MSG_ID改為3字節(jié)后很多消息的索引已經(jīng)變了。我把數(shù)組改為直接從mavgen生成的v2頭文件里提取重新編譯后CRC全部通過。這個(gè)坑的教訓(xùn)是CRC_EXTRA表必須和協(xié)議版本、消息定義嚴(yán)格綁定不要抄網(wǎng)上流傳的“通用表”。5.3 飛控能收不能發(fā)載荷長(zhǎng)度與消息ID不匹配還有一種情況是接收正常發(fā)送卻一直被對(duì)方忽略。用QGroundControl連接飛控時(shí)飛控能正常收到地面站發(fā)來的命令但地面站一直收不到飛控的姿態(tài)數(shù)據(jù)。排查鏈路先排除CRC問題——因?yàn)镃RC計(jì)算和接收用的是同一套表如果接收正常CRC本身應(yīng)該沒問題。再檢查消息ID發(fā)現(xiàn)我發(fā)送姿態(tài)消息時(shí)往消息ID里填的是HEARTBEAT的ID而負(fù)載卻是ATTITUDE的內(nèi)容。這個(gè)錯(cuò)誤在協(xié)議層很容易被忽略因?yàn)镸AVLink接收端往往只按消息ID去匹配解析邏輯不會(huì)檢查負(fù)載內(nèi)容是否合理。結(jié)果就是地面站收到了ID為30的消息按ATTITUDE格式解析得出一個(gè)奇怪的角度值干脆把它當(dāng)無(wú)效數(shù)據(jù)丟棄。這也引出一個(gè)設(shè)計(jì)經(jīng)驗(yàn)消息ID和負(fù)載的定義必須一致不僅在代碼層面最好在規(guī)劃文檔里也理清楚。發(fā)消息前先做一次“發(fā)送拜拜測(cè)試”用pymavlink收到這幀后把msg.get_type()答應(yīng)出來確認(rèn)ID和負(fù)載匹配再往上層用。6. 一個(gè)親測(cè)有效的小技巧最后分享一個(gè)我在多個(gè)項(xiàng)目里驗(yàn)證過的小技巧拿到一套新的MAVLink收發(fā)源碼無(wú)論它來自官方、開源社區(qū)還是自己寫的先不要直接接到飛控上聯(lián)調(diào)。第一步是把它插到電腦上用pymavlink跑一個(gè)回環(huán)測(cè)試——把自研代碼的發(fā)送引腳和pymavlink的接收引腳短接反之亦然然后用pymavlink發(fā)一幀標(biāo)準(zhǔn)數(shù)據(jù)觀察自己的代碼能否正確解析再讓自己的代碼發(fā)一幀用pymavlink解析。這樣可以在不依賴飛控、不受真實(shí)鏈路干擾的情況下把協(xié)議層的收發(fā)正確性驗(yàn)證得明明白白。等這一步全部通過再上飛控聯(lián)調(diào)你會(huì)發(fā)現(xiàn)自己省下了至少一個(gè)下午的排錯(cuò)時(shí)間。MAVLink這東西協(xié)議本身并不難難的是細(xì)節(jié)而這些細(xì)節(jié)幾乎都是可以提前在桌面上就排查掉的。本文還有配套的精品資源點(diǎn)擊獲取
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
亚洲黄色电影| 中文字幕黑人大片| 亚欧高清在线| 精品中文字幕第一页| 亚洲色图 综合| 欧美熟妇乱码在线一区| 天天日天天爽| 欧洲无码一区二区| 午夜福利成人免费视频| 亚洲 日本 国产 综合| 男女啊啊啊| 亚洲图片 激情小说| 日本三级黄页| 91在线无码精品秘 软件| 日熟女| 午夜毛片亚洲精品片国产久久久| 日韩丨制服丨中文|在线| 最新av在线| 天美传媒av 在线| 爽 好舒服 无码刺激久久| 国产JDAV无码视频在线观看| 久久粉色| 欧美亚洲在线| 国产一区二区三区导航| 国产高清精品一区二区三区毛片 | 欧美精品一区二区少妇免费A片 | 麻豆天美国美国产AV| 日本欧美亚洲高清在线看| 夜草网站| 性夜影院爽黄A爽免费动漫| 久久人妻一区二区三区高清 | 91色人妻| 欧美v亚洲v综合v国产v妖精| 摸奶性爱视频网站在线免费播放| 国产高清视频无码在线| 日本三级A片网站com| 国产毛片片精品天天看视频| 男女国产精品| 香蕉人欧美综合| 免费国产视频| 欧美影院一区二区三区| 久久产精品一区二区三区电影| 欧美日韩欧美| 国产精品无码久久久久2025| 美中日韩无码| 九九毛片这里只有精品| 超碰97资源中文字幕| 国产精品一区二区三区在线密挑| 四虎影视在线| 久操在97| 欧美+日产+中文| 国产精品乱码久久久久| 中文AV制服乱伦| 日韩有码 一区二区三区| 日韩av在线精品观看| 天美精品原创av片国产| 国产野战露脸在线播放| 国产成人精品日本视频| AA丁香综合激情| 日本韩国一本产品小视频日本韩国一本产品久久久产品小视频日本韩国一本产品久 | 日韩91网| 国产精品午夜福利亚洲综合网| 日韩三级伦理中文字幕| 乱欲一区二区| 黄色AV影视| 久久伊人在线五区| 久久久国产护士丝袜美腿一| 香港澳门日本三级网站| 中文字幕亚洲热播人妻| 国产成人无码久久精品| 九九九九九九九九九九九九九九九女| 色婷婷一区二区三区久久午夜成人不| 天堂无码| 自拍偷拍2025在线观看| 国产有码一区| 少妇精品久久久八区九区| 中文 人妻 制服| 成人无码在线超碰网| 人人妻人人狠人人| 亚洲综合图片在线| 欧美亚洲自拍另类人妻| 国产天美欧美| 超碰综合97在线| 国产传媒一区二区三区| 国产精品香蕉热久久新品| 992这里有精品| 欧美人妻二区三区| 蜜臀Av一区二区三区| 国内偷拍精品一区二区| 午夜男女爽爽爽在线视频 | 国产少妇与亚洲av| 超碰久久.com| 你想操日本小逼吗| 欧美综合色站| 天天看片青娱乐| 亚洲精品第一| 嫩草影院永久在线制服丝袜| 超碰78| 精品人妻av在线播放| 国产天美欧美| 欲香欲色综合天天伊人| 国产 亚洲 丝袜 制服| 少妇六月天| henhen91| 欧美黄色片AAAAA| 亚洲综合113页| 欧美黑人与女人91| 在线中文字幕极品av| 97一区二区蜜臀| 啊啊啊久久| 欧美日韩国内不卡| 天欧美在线| 亚洲欧洲日本精品中文a∨| 骚货| 加勒比伊人| 操人妻少妇中文| 91色欧美| 少妇一线天久久久久久| 亚洲天堂男人天堂网| 欧美一区二区亚洲天堂| 天堂亚洲欧美| 蜜臀av在线播放一区二区三区| 人妖欧美一区二区| 99亚洲天堂| 91精品国产综合久久久蜜臀酒店| 白嫩嫩一区| 欧综合网| 99天天超碰| av网站国产主播在线| 1区2区3区在线视频| 97国产|免费| 色婷婷综合网站| 欧美综合色图片| 国产热RE99久久6国产精品首 | 亚洲激情在线| 久草午夜| 最新精品久久蜜桃| 国产懂色精品国产av| 尤物AV免费网站| 香蕉久久国产AV一区二区| 日韩AV噜噜噜一区二区三区四区| 在线只有精品| 亚洲精品尤物yw在线影院| 日本日日色视频| 国产福利视频精品视频| 91成人精品| 红杏大香蕉| 亚洲国产97| 国产白嫩精品久久| 欧日a| 熟女精品日韩一区二区三区| 日韩欧美成人大香蕉| 蜜乳AV免费观看| 亚州综合图片| 色色激情| 久久精品店| 骚熟女AV网| 久久欧美1卡2卡3| 久久精品国产AV一区二区三区| 欧美在线55555| 黑人嘿嘿嘿超爽免费视频| 91色射| 亚洲熟女国产综合另类| 这里只有精品视频在线| 亚洲国产一区二区日韩专区| 欧美少妇高潮| 久久精品72| 中文字幕 国产区| 天美传媒av 在线| 岛国1区2区3区在线观看| 久干网| 发朗少妇买婬全视频中文| 色色色日本| 97在线公开视频| 国产美女91视频| 欧美很很操视频| 不卡中文字幕aⅴ在线| 伊人四虎综合| 97超碰天天爱天天爱| 日韩亚洲Av人人夜夜澡人人爽| 国产高清自拍| 高清视频一区| 在线五区| 欧美视频激情久久久久久| 性爱视频久久| 探花一区在线| 国内毛片无码一级毛片| 国产浮力影院第1页| 九九九九热| 97在线播放 | 久久精品高清无码一区| 精品九九淫乱男| 大香蕉色网| 丁香五月婷婷色| 久久久久久AV无码免费网站| 人人操肉肉| 亚洲性爱成人| 日韩精品第3页| 丁香六月婷婷| 五月婷婷激情| 丁香五月性| 人人摸人人添人人操 | 成人久久无码www| 亚洲天堂,男人| 日韩av影片在线观看| 久久精品国产AV一区二区三区| 久久久精品网| 亚洲国产丝袜熟女av| 中国少妇啪啪视频| 亚洲男人在线观看天堂| 99视频自拍区| 91美女片在线| 超碰在线91| 夜色91| 亚洲欧美伦综合| 东京男人天堂| 91观看 国产白丝| 人妻91少妇| 国产一区二区精品久久久不卡蜜臀| 91激情综合| 久久久久9999精品九九九| 女生自91网站| 国产精品无码在线| 青青草中文-久久青草精品一区二区三| 亚洲女毛多水多21P| 人人操人人大香蕉| 色色五月婷婷| 大香蕉天天看妹子| 91伊人久久在线| 亚洲精品国产熟女久久久| 超碰久久综合| 麻豆 美女 丝袜 人妻 中文| 国产肏逼网站| 强歼乱伦资源网| 青青草天天亲夜夜操网| 色欧美天天| 91亚洲欧美色图| 噜噜噜亚洲精品| 久久久久久无码人妻中文字幕| 欧洲一区二区三区四区在线观看| 天堂性色| 国产无码精品高清| 五月丁香影视| 啊啊啊啊操死我了| 亚洲毛片基地专区| 亚洲欧洲激情| 91久久九九精品国产综合| 神马久久久久久伦理片| 99热9| 刺激性视频黄页| 国产精品视频在线播放 | 91色久| 天天干天天做| 日韩美女,国产传媒,视频一区| 蜜桃臀一区二区三区久久| 香蕉视频精品亚洲一区二区三区在线播| 蜜臀久久99精品久久久久久-DVD原版全| 熟妇综合一区二区三区| 91呆哥人妻| 久久av网| 国产色图乱伦| 日夜尻逼网| 天天澡天天爽日日AV| 免费在线黄片视频| 夜夜人妻爽| 91美女在线| 日va操| 久久久久久久久久久人妻| 精品9区| 麻豆美女丝袜人妻中文| 欧美顶级黄片AAAAA在线免费看| 日韩伦理视频| 草草草视频| 国产精品无码在线| 亚洲激情色片| 欧美视频一| 亚洲av在线免费观看| 欧美玖玖爱免费玖玖| WWW.操逼.COM| 精品国产一区二区三区av在线资源| 国产亚洲精品美女| 噜噜噜在线视频| 91久久午夜无码鲁丝片久久人妻| 激情综合网亚洲| 二色av| 日韩欧美中文| 黄资源| 激情五月综合开心五月| 在线人妻熟女一区二区三区四区五区| 性生活性生大爱77AV国产| 黄色片,com| 亚洲图片欧美制度| 国产精品白丝在线播放| 色91综合网| 丰满人妻被猛烈进入中| 麻豆天美国美国产| 91久久免费视频互動交流| 99这里有精品| 高清国产精品无码| 日本东京热大香蕉a片| 成人午夜高潮av猛片| 亚洲aw毛茸茸在线 | 青青草九九九九九| 亚洲av青草久久一区二区| 碰碰在线视频| 日本精品中文字幕视频| 欧美性爱一内片一区二区三区| 人妻久久一区二区三区 | 视频在线观看青青99国产| 国产女人和拘做爰视频| 精品无码产区一区二| www.91理论| 日日嗨AV一区二区夜夜| 黄污污污污| 男人在线天堂| 另类亚洲一区二区三区| 精品国产72| 欧美偷拍区| 91制服丝袜中文字幕| 人妻少妇精品久久久久久久| 东北毛片| 目产99999久久999| 亚欧Av| 亚洲男人天堂2017| 欧美亚洲20p| 欧美伊人久久综合网| 9精品久久| 欧美黄色大香蕉一区二区| 麻豆熟妇乱妇熟色A片在线看| 桃色五月天| 国产精品久久久吖| 日本一二三免费久久| 一区二区三区精品黑丝白丝酒店对鸡 | 欧美日韩亚洲少妇寂寞影院正在播放 | 成人三级片一区二区三区视频| 96AV精品| 亚洲色欲天天人妻无码系列专区| 国产免费一区2区3区| 磁力99AV| 久久综合18p| 最新中文字幕在线亚洲| 蜜桃狠狠色伊人亚洲综合网站| 久久一二三四不卡 | 国产白领连续中出在线观看| 日韩一区二区高清在线观看的| 亚洲天堂少妇| 人人操天天爽| 五月丁香六月婷| 大香蕉乱级| 欧美日韩亚洲少妇寂寞影院正在播放| 国产AV天美| www久| 亚洲精品尤物yw在线影院| 9美女超碰在线免费观看| 中文字幕日韩精品一区二区三区| 99综合| 国产综合永久精品日韩鬼片| yw尤物av无码点击进入麻豆| 日躁天天爽爽| 中国91AV| 噜噜噜噜天天狠狠| 国产丸一视频| 久久欧洲| 超碰色中文| 丁香五月久久| 国产AV超爽| 九九九九免费高| 久久久久久久久久久97| 九九性视频| 人人操人人大香蕉| 成人免费福利网站国产| 国产精品无码久久久久2025| 东北丰满熟女国产一区| 国产一区二区免费福利片| 97狠狠| 日韩天天综合| 婷婷九月丁香| 国产性刺激| 日本日逼高清| 国产亚洲中文不卡二区| 69少妇一区二区| 人妻五十路在线| 91在线美女| 青娱乐国产精品| asc国产精品| 成人电影一区| 99热国产| 熟人人妻少妇精品久久| 欧美日韩97| 国产精品网站www| 人妻少妇精品视频一区二区三区| 亚 欧 美 综合| h在线看免费版在线看| 中文一区二区| 亚洲熟女偷拍在线观看| 久久精品女同亚洲女同13| 偷拍片久久| 亚洲熟妇综合久久久久久| 熟女高潮合集-永久久久-成人AV | 女人的天堂大香蕉网| 综合网亚| 色妇91| av草草在线电影| 亚洲天天自拍| 中国AAAAAA黄色片| 超碰色男人操熟女| 成人三级片无码| 性爱1区| 狠狠色婷婷777| 91超级碰碰碰| 国产精品久久久久久夜夜夜| 国产第二页| 亚洲欧美综合网站| 日韩15p| 69国产对白刺激| 国产成人无码a| 日本国产高清色www视频在线| 午夜寂寞欧美| 亚洲欧美另类图片| 中日韩免费看男女操逼大全| 家庭乱伦国产| 超碰在线91| 99999精品视频| 天天摸夜夜操视频| 无码78| 欧美的性爱网站免费| 亚洲成a人片在线观看中文!!!| 国产一区二区三区影片| 日日干夜夜操视频h| 中文一区二区| 性爱视频啪啪啪啪| 丁香五月影院| 欧美在线综合| 精品国产av一区二区三区四区入口| 综合五月婷婷亚洲一区| 色av中文字| 日日躁狠狠躁天天躁精品| 97视频免费在线观看| 亚洲午夜福利在线影院| 天操天操夜操夜月操月年年操 | 美國A片| 欧美精品另类人妖xxxx| 色69大色97香蕉| A级片日韩欧美国产欧美视频精选观看 | 国产亚洲色婷婷久久99精品91| 亚洲最大黄网| 九月伊人中文字幕| 欧美十八禁网站| 偷拍亚洲高清图片| 亚洲人妻久久| 性一交一乱一交A片久久四色| 97超碰免费人人性爱| www激情| 综合91网| 日本人妻中文字幕精品| 精品久久99| 99久在线精品99re8蜜桃| 久久人人爽爽人人爽人人片αV| 亚洲人成色9999精品久久 | 大伊香蕉在线视频免费| 亚洲色图伊人网| 91在线精品一区二区三区| 欧美黑人与女人91~| 久草这里只有精品| 熟妇在线视频一区二区| 9精品久久久久| 综合影视国产无码| 97超碰人操| 免费αⅴ在线观看| 97爱b| 一级做a爰片久久毛片图片| 97香蕉人人乳| 操操吧亚洲乱伦视频| 欧美无圣光在线| 97色伦97色伦国产欧美| 四虎免费看黄| 日韩乱伦影音先锋| 日韩高清一二三| 国产精品成人无码av无码免费| 色综合99999| 岛国视频一二三区| 女人天堂网| 国产成人无码网站在线视频| 国产精品亚洲免费| 九九九久| 日本三级久| 一区二区中文| 欧美夜色| 欧美疯狂做爰xxxx| 国产熟女无套内射| 麻豆国产av网| 国产极品美女高潮无套在线观看| 天天天堂影视日韩亚洲91| JIZZJIZZ国产精品喷水| 亚洲欧洲日韩中文字幕一区| 蜜臀av在线播放一区二区三区| 91熟女视频| 色狠人在线99| 伊人女女资源在线观看| 97国产超碰| 97亚洲资源| yellow网站免费观看日韩高清无码| 校园春色欧美| 射 色综合| 国产亚洲精品精AV.| 亚洲色91C| 天天色综合天天操| 美腿色图| 国产 日韩 另类 视频一区爱| 欧美亚洲系列| 91天天爱| 国产按摩一区二区三区| 国产一区二区a毛片| 极品少妇久久久| 中 文字幕一区二区三四 五 区日 日 骚 | 色色网91| 992视频一区| 日本97久久久精品| 久热大香蕉| 97色伦97色伦国产欧美| 人妻另类| 久久久久元码视频| 99自拍B亚洲 | 亚洲国产精品久久AV| 蘋果手機免費看成人Av| 97 亚洲 日韩 欧美 在线| 亚洲1区2区三区高清中文字幕| 99av| 久久精品国产97欧美精品亚洲| 日韩三级网址| 95人妻爽爽人人做人人澡| 啪啪啪东京| 97色网| 东京男人天堂| 亚洲色丰满少妇高潮| 成人五月香网在线| 90后性网国产欧美| 成人三一级一片aaa| 日韩成人性日韩成人性爱视频在线免费观看| 久久人妻无码毛片A片麻豆| 熟女啪啪视频| 在线二区不卡| 五月开心久久AV官网| 性色avv| 国产 日韩 欧美 人妻 熟女 中文| AAAAAAAAA黄片| 国产精品嫩草影院午夜两性| 校园春色五月天| 久久久亚洲熟妇资源| 肉丝无码中文高清| 国产青青美女玩逼视频| 日日AV加勒比| 5252色欧美在线| 91neishe| 青青青国产| 国产青一二三| 97精品国产97久久久久久免费| 26uuu国产| 久99热| 能看的AV| 久久午夜伦| 日韩人妻资源在线看| 国产激情久久久| 亚洲欧美啪啪| 天天日骚逼熟女| 一摸二插三插| 欧美色蜜桃97| 超碰97伊人| 亚洲欧美洲综合| 青青在线视频日韩欧美| 色欲天天综合久久久无码网中文| 日本精品一区二区三区四区的功能| 精品人妻一区二区三区不卡断| 天干天干天干天天做| 欧美九九九| 九久9精品| a级免费在线观看| 国产高清午夜成人在线观看| 在线观看无码三级少妇| 久操网视频| 福利在线黄片| 亚洲老熟妇xxx| 国精品一区二区三| 欧美高清无码免费视频高清版| 伊人国产成人av网站| 在线观看亚洲成人精品| 黄片免费久久久久久久| 久久久九九网站| 亚洲欲色9532548967一区| 天天香香欲综合| 我中文字幕6区| 午夜经典| 一级人妻性爱视频| 日本精品不卡一二三区| 天天日老熟妇| 黑人精品久久97| 密臀在线一区尤物| 另类小说综合网| 中文字幕 国产 精品| 啊a一区在线| 91国产丝袜美女| 欧美AB在线| 国产精品久久久久久照片| 精品人人插人人操| 欧美色天堂网在线视频| 97伊人超碰| 青青青国产手线观看视频2| 91成人久久| 麻豆久久视频在线地址| 色臀aV| 亚洲阿v天堂在线| 日本日皮视频逼| 桃色六月天| 亚春色色| 91爰爱欧美| 欧美天天干| 欧洲一级性爱视频在线观看| 99999精品成人| 欧美综合综合| 日本免费中文字幕在线| 欧美淫穴| 4tube欧美女厕所| 在线播放免费av福利片| 亚州精人品大香蕉| 欧美综合网站999| 无码国产Av| 人妻在线中出视频| 无码78| av资源在线播放天堂| 色天堂在线观看| 色欲久久久久综合网| 人人摸人人干| 亚91网| 男人的天堂一区三区| 久草综合视频| 99在线免费公开视频| 久久久久久久久久久97| 中文字幕乱码在线观看| 99久久九九| 91痴汉| 欧美东京热精品A∨| 精品国产国产AV| 欧美日韩*字幕一区| 天天看少妇| 69精品| 96AV精品| 免费试看60秒| av婷婷色网| 天天综合91在线| 999国产精品999久久久久久| 日韩乱插| 中国91AV| 国产欧美第五页| 黄页av| 国产伦精品一区二区三区视频女| 亚洲天堂男| 人妻熟女午夜精品在线| 大香蕉伊人75| 狼人综合婷婷激情四射| 日韩欧美亚洲自拍偷拍| 91偷拍欧美亚洲| 国产精品蜜臀久久久久无码AV| 1区2区3区中文字幕日韩| 1769国内精品视频| 超碰1997| 99久久精品国产高潮| 九九九国产精品| 99热| 国内毛片热久久思思热| 麻豆成人av| ?亚洲伊人伊成久久人综合网| 9.1小视频| 亚洲少妇喷视频看| 久久这里只精品免费福利| 超碰在线97国产| 日本精品第一视频在'| 这里都是精品| 天堂麻豆天美| 每日更新AV| 屁股久久久久久| 日韩99神马视频片| 色青青久久影视| 91视频国品一二三区| 日韩av无码网站| 欧美熟妇亚洲版| 九九色热| se吧提供91精品国产91久久久久久| 久日综合网| 人人操av| 日韩激情小说一区二区| 麻豆色约约| 欧美超碰96| 一区三区啪啪| 国产操逼网站亚洲一级黄色| 成人精品视频| 天天淫人人妻日日色| 思思热在线cao| 777超碰| 东京热不卡视频| 日本三级韩三级99久久| 天天操天天干一区二区| 激情欧美97| 欧美黑人极品高潮喷吹熟女黑人性暴力日韩在线欧美极品一区二区老师 | 蜜臀久久99精品久久久久久-DVD原版全| 欧美日韩大陆黑人少妇99| 91精品黄在线观看| 翔田千里Av在线| 超碰色97| 欧美九一精品久久久熟妇| 福利风月五月天影院| 国产精品一二三在线看| 中文字幕蜜乳av| 国产精品夜夜夜| 秋霞午夜视频一区二区| 亚洲国产欧美日韩人妻日中文| 刺激精品视频| 热久久精品| 九九成人| 亚洲成?V人片在线观看福利| 素人一区二区三区日韩| 欧美日本成人一区二区| 91操熟妇| 中文熟女五十乱码在线| 97久久精品国产| 国产av高清版| 91 刺激在线| 日欧操屄视频| 日本精品一区二区中文字幕| 色五天伊人| 国产精品无码成人精品| 中国人高清www色视频免费| 久久大香蕉97| 97久久久久久久久久| 91少妇香蕉久久精品| 91欧美长吊| 大香蕉97久久| 国产一区二区三区中文字幕| 91欧美| 午夜免费福利视频一区| 日本高清一区二区在线| 很黄很色的视频在线观看| 人人做,人人操,人人摸| 亚洲无992tv| 欧美中出| 天天澡天天爽日日AV| 精品在线蜜臀| 综合久久9| 97天天摸天天爽| 久久伊人影院| 天天肏天天干| 中文字幕乱码在线| 啊啊啊啊啊啊啊国| 精品超碰中文在线| www四虎| 日本美女性生活久久久久久久| 国产女上位好爽在线| 夜夜肏2021| 99精品丰满人妻无| 亚洲精品国产精品乱码不99| 久久久久久AⅤ无码免费肉站| 亚洲不卡三级手机播放| 国语av狠狠色丁香婷婷综合激情| 欧美不卡五十路| 新亚洲无码| 国产亚洲精品无码三区| 男女日B国产| 性爱免费视频成人| 日本一区二区三区四区免费观看| 国产一区二区视频在线播放| 强免费黄色网址| 国产毛片精品一区二区色欲黄A片| 国产一级片| 67914在线精品观看| 日本精品国产视频| 中文子幕一二三| 亚洲精品黄码久久久久| 国产无码精品无码| 日本一级婬片试看三分钟| 俺去俺来也在线www| 91色久| 欧美亚洲影视| 亚洲色性情三级| 97少妇人妻中文字幕久久 | 亚洲五月婷| 啊啊啊啊视频免费| 色哟哟1区2区| 男人的天堂va| gogogo免费高清看中国国语| 97精品网站| 国产精品伦理| 五十路六十路七十路熟婆| 亚洲超碰AV| 日本 欧美 亚中文字幕| 人人搡人人肉久久精品| rivers-china.com| 麻豆综合一区av| 久久香蕉综合一本到3atv| 97天天摸天天碰| 天天综合网1| 男人天堂2030| 操逼天美3区| 久久精精区一区二区一蜜桃一区二区| 啊啊啊啊啊在线视频| 四虎在线视频| 69一区二区| 人人色人人操在线| 青青青青草av在线观看| 床戏久久久av一区二区麻豆| 国产强奸乱伦xd| 97自拍视频在线| 久久超碰av在线| 2020久久免费视频| 中文字幕三四区| 无码聚合| 蜜桃久久久久久久久久久久| 久久99国产精品| 黄片www.| 亚州色站 日韩电影| 男人的天堂久久久| 久久久97| 热的中文 热的有码 热的国产| 视频国产成人精品日本亚洲18| 亚洲一区日韩| 亚洲啪啪啪啪视香蕉| 综合网亚| 国产97色在线| 国产精品探花视频| 少妇与黑人高潮在线| 日躁天天爽爽| 久久久啊啊啊| 婷婷丁香五月激情啪啪| 久操在97| 乱伦一区二区三区‘| 97综合日韩| 深夜福利黄片| 狠狠综合网| 欧美性爱网97| 100啪啪视频大全| 成人影 天天操 亚洲| 欧美九九九九九| 婷婷亚洲综合| 中文字幕乱妇免费视频| 国产AV高清AV无码| 欧亚 另类 久| 操美女高潮抽搐白浆| 97日韩欧美亚洲| 操逼日韩无码 | 久久性爱精品一区| GVH-003 母子姦 青木玲-麻豆视频,麻豆视传媒短视频网站入口,麻豆视传媒官网直 | 久久久精久久久| 亚洲天天更新| 亚洲欧美中日韩| 国语av狠狠色丁香婷婷综合激情| 国产视频三区四区| 亚洲国产一级黄色视频| 福利偷拍视频-中文字幕2019国语完整视频大全-S91AV | 欧美性色欧美| 天天爱天天操| 在线日韩日本亚洲国产| 欧亚第一综合网| 国产隔壁老王影院在线| 亚洲欧洲综合成人av一区| 中文字幕一二三区| 超碰国产精品久| 99啪啪| 日韩亚洲中文有码视频| 超碰在线成人电影| 婷婷色导航| 丰满人妻区一区二区三| 国产农村妇女精品一| 人人看欧美性爱| 欧美婷婷久久| 手机看片1024你懂的国产| 78m成人视线| 婷婷综合| 亚欧免费观看视频| 啊啊啊啊啊啊啊在线| 欧美人人AAA| 张柏芝国产一区在线观看| 蜜臀少妇一区二区| 黄色人人| 国产熟女一区二区| 在线综合 亚洲 欧美中文字幕 | WWW操逼| 97视频在线观看网站| 婷婷视频网| 国产成人拍国产亚洲精品| 日本熟妇精品九九| 日韩人妻资源在线看| 免费看片黄| 国产亚热在线久久| 精品99999久久久久久| 欧美日韩亚洲一区二区在线观看| 中文字幕一区二区三区人妻不卡 | 97这里都是精品| 国产AV高清AV无码| 国产精品久久久久久久无码AV| 91青青在线视频| 亚洲精品一区二区三区新线路| 97干天天| 亚洲综合色男人网| 久久五十路熟女人妻| 麻豆视频一区二区| 强奸熟女一区二区三区| 久久人妻视频网| 青娱乐国产精品| 九九九九久久久久| 亚洲久草AV色图| 日本99一区二区| 99热9| 欧美日本国产日韩激情视频| 9999久久久| 国产农村妇女毛片精品久久| 欧美亚男人的天堂| 久热超碰| 国产AV高清AV无码| 天天弄天天操| 四虎午夜影院| 欧美精品庄| 啊啊啊轻点在线观看| 美女毛片999| 91 手机在线播放 绯色| 亚洲精品三| 亚洲av综合色| 国内偷自视频区视频综合| 97这里只有精品| 久久中文字幕人妻熟av女蜜柚| 嗯嗯啊好大| 人妻在线臀日韩| 欧美色三级片91| www.狠狠| 强免费黄色网址| 欧美日韩国产色图在线| 欧美色视频在线| 国产一区自拍欧美日韩| 欧美日韩午夜精品一区二区三区| 青娱乐啪啪视频| 亚洲AV色图| 啊啊啊操死我了| 久久激情视频| 99热线麻豆 | 色情五月丁香| 新版天堂中文资源8在线| 国产精品久久久久无码A√| 老熟女乱伦一区| 自拍内地三级在线观看| 无码高清操逼| 免费成人在线观看91| 国产肏逼网站| 夜夜嗨av午夜成人| 色噜噜综合在线| 大鸡吧尹人在线| 婷婷五月天久久精品视频一区二区三区| 色蜜AV| 亚洲AV乱码专区国产噜噜亚洲| 中文字幕成人| 女同在线视频一区| 国精品一区二区三| 成人网欧美风情| 91AV天堂| 97欧美色| 99re黄| 色欲久久久久综合网| 日韩免费一级性爱视频| 久久久久久日韩| 女同性恋久久| www.狠狠操| 亚洲国产综合久久久性感熟妇| 97免费视频网| 啊啊啊要高潮了| 日韩欧美三级| 日本加勒比无码专区| 一级性爱视频免费在线| 中文字幕乱在线伦视频中文字幕乱码在线 | 熟妇女伦乱视频视频| 蜜臀99精品国产高清在线观看| 日本男人天堂| 国产福利电影| 大伊香蕉在线视频免费| 日韩成人精品中文字幕| 日韩精品人妻中文字幕有码午| 中国熟女网站| 东京热91| 日韩美女啪啪一区| 午夜黄色免费在线观看| 神马久久久久眼| 日韩精品作爱导航| 欧美综合综合| 国产亚洲精品A在线观看下载| 欧美性爱视频免费一区一A| www超碰| 久啪| 97国产超碰| 国产av强奸美女| 999狠狠综合| 韩日精品福利视频一区不卡在线免| 亚洲黄色电影| 国产不卡免费在线视频| 国产9l 大屁股| 精品日韩中文在线| 日本一本一区二区三区四区五区欧美日韩中文字幕| 91色碰| 色九九久九九| 亚洲欧美综合区自拍另类| 色色国产| 夜夜嗨免费视频| 香伊人在线| 婷婷色在线| 美女黄码视频午夜| 啊啊啊啊啊啊好多水| 日韩欧美国产高清视频| 中日韩久久人妻一区二区| 国内精品99999| 美国aaaaa一级黄片| 麻豆九九九| 少妇熟女一区二区三区| 深夜激情无码| 蘋果手機免費看成人Av| 国产三级片在线观看| 黄色高清无码无码破解免费暗网 | 国产捆绑一区| A级毛片在线看免费| 男人亚洲91首页在线| 一本大道青青| 国产精品久久99日日| 久久九七| 富女玩鸭子一级毛片| 丁香六月天| 九九九偷拍| 国产视频一区二区免费| 91熟女综合| 看免费的黄片| 欧美综合第一| 亚洲综合电影| 大香蕉亚洲中文| 97亚洲色图| 90后性网国产欧美| 久久九九久精品国产尤物|国产精品爽黄69天堂A片潘金莲,国产亚洲精品第一综合 | 凹凸视频在线一区二区| 99超级碰免费视频| 国产97在线播放| 爽 好舒服 无码刺激久久| 熟女AV一区| 日日操丁香五月天| 久久久免费懂色| 亚洲国产奇米影视久久| 丝袜翘臀后入欧美校园亚洲自拍另类小说一区中文字幕少妇诱惑 | 国产一区二区三区不卡手机在线| 亚洲日韩天堂| 久热伊人99re| 九九九久久久| 好吊色一区| 日韩激情小说一区二区| 少妇69中文| 激情国产乱伦Av| 综合性视频99| 国产强奸超碰AV| 少妇熟女视频一二三区| 激情专区综合| 欧美96在线|欧| 久久久久久999| 麻豆天美电影一区二区| 97精| 安徽熟妇视频| 性爱边摸边日免费AV| 亚洲drav色图| 一区二区三区机械有限公司| 久久二| 日本天天人人狠狠在线日美女| 欧美亚洲天天| 蜜桃成人1区2区3区| 国产9 9在线 | 亚洲| 国产欧美黑人丰满在线| 国产 丝袜 欧美中文 另类| 亚洲无码一区成人免费午夜| 伊人大香蕉在线| 亚洲?V无码专区在线电影| 亚洲综合 欧美| www.色五月| 亚州熟女乱伦| 国产精品久久久久999| 色优久久| 日韩免费中文字幕视频| 中文字幕第23区| Julia在线播放亚洲久久| 国产成人亚洲精品无| 精品无码久久久久| 丰满人妻一区二区三区| 日韩有码中文字幕女同性恋| 人妻一区久久二区三区色播| 中国国国产一级特黄毛片| 亚洲风情在线观看| 九九成人精品| 婷婷香蕉| 国产精品亚洲一级av第二区| 亚洲第一男人天堂| 日日日啊啊啊| 熟女乱伦二区| 天天干天天舔| 怡春院久久| 亚洲一区二区 麻豆传媒| 久久婷婷伊人| 91成人在线| 99热9| 玖玖玖玖精品国产剧情| 蜜臀视频网站| 亚州精品人妻一二三区| 97爱爱影院| 国产精品亚洲免费| 爽极品影院| 日韩在线国产字幕| 亚洲影视高清第一页| 日本加靬比网站发布页| www.99热| 粉嫩不卡一区二区性爱| 精品无码久久久久久久杏吧| 日韩欧美~中文字| 欧美97日韩精品| 极品五月天噜噜| 午夜男女爽爽爽在线视频 | www.色操逼| 一区二区三区成人高清视频| 亚洲影视综合| 亚洲综合色图欧美| 狠狠做深爱婷婷久久二区| 色狠狠综合噜一二三区| 亚洲.欧美.丝袜.中文.综合| 免费的黄片wwwwww| 欧美性爱第一页久久| 国产又粗又长的视频| 99精品人人爽| 欧美A√综合网| 久久手机视直播| 人妻天堂综合网| 五月婷婷综合激情| 人人操人人色人人摸| 欧美色狠| 97爱综合| 天天插网| 超碰美国| 97久久国产| 97欧美| 欧美91在线| 老熟女网站| 97色亚洲| 91肉片| 少妇综合网| 97天天日| 农村女一级毛卡片| 91粉嫩萝控精品福利网站_精品影音先锋国 | 中国黄色特级精品一区二区三区片| 日本丝袜美腿人妻九九| 中文字幕av色| 欧美日韩国产在线| 五月天婷婷欧美三区| 日韩欧美视频青青| 最新AVzaixian| 91xingse| 啊嗯好大视频在线观看| 97精品久久久久久久|