欧美成人午夜精品久久久,国产?V天堂一区二区三区,欧美精品va在线观看,亚洲一区二区三区免费在线观看,av无码精品一区二区久久,欧美性爱视频不卡一区三区,欧美乱人伦视频在线观看,国产一级牲交高潮

ARTICLE DETAIL

資訊詳情

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

飛控計(jì)算機(jī)硬實(shí)時(shí)操作系統(tǒng)選型與核心機(jī)制解析

飛控計(jì)算機(jī)硬實(shí)時(shí)操作系統(tǒng)選型與核心機(jī)制解析 先說個(gè)結(jié)論飛控系統(tǒng)選型實(shí)時(shí)性不是選項(xiàng)是門檻。在正式開始講飛控計(jì)算機(jī)常用的硬實(shí)時(shí)操作系統(tǒng)RTOS之前有必要先把這個(gè)詞拆開看——為什么大家反復(fù)強(qiáng)調(diào)“硬實(shí)時(shí)”而不是隨便找一個(gè)通用操作系統(tǒng)或者“看起來實(shí)時(shí)”的軟實(shí)時(shí)系統(tǒng)頂上。飛控計(jì)算機(jī)承載著姿態(tài)解算、導(dǎo)航融合、指令輸出、傳感器采樣這些任務(wù)任何一個(gè)環(huán)節(jié)出現(xiàn)不可預(yù)測(cè)的延遲輕則控制品質(zhì)下降重則直接導(dǎo)致失控。硬實(shí)時(shí)操作系統(tǒng)在這里扮演的角色就是確保關(guān)鍵任務(wù)在確定的時(shí)間窗口內(nèi)完成誤差按微秒、毫秒來度量而不是“盡量快”。這篇文章面向的讀者是正在做飛控軟件開發(fā)、無人機(jī)/航天器/工業(yè)自動(dòng)化項(xiàng)目的工程師或者打算從裸機(jī)程序遷移到RTOS、正在為平臺(tái)選型頭疼的朋友。我會(huì)從硬實(shí)時(shí)的底層邏輯講起逐個(gè)分析幾種主流RTOS的現(xiàn)狀與選型要點(diǎn)再把調(diào)度、中斷、時(shí)間管理這些核心機(jī)制掰開揉碎最后結(jié)合我實(shí)際開發(fā)中踩過的坑給出可直接落地的排查手段。內(nèi)容不堆教科書概念全是能用的東西。1. 硬實(shí)時(shí)到底在解決什么問題很多人一開始接觸“硬實(shí)時(shí)”這個(gè)概念以為就是“反應(yīng)快”。其實(shí)“快”和“確定”是兩碼事。飛控系統(tǒng)要的不是平均延遲低而是最壞情況延遲有上限。這個(gè)區(qū)別如果不搞清楚后面選型、設(shè)計(jì)任務(wù)模型的時(shí)候一定會(huì)出問題。1.1 硬實(shí)時(shí)與軟實(shí)時(shí)的本質(zhì)差異拿生活里的場(chǎng)景類比一下。外賣平臺(tái)說“預(yù)計(jì)30分鐘送達(dá)”如果今天30分鐘、明天40分鐘、后天超時(shí)了賠你一張券這就是軟實(shí)時(shí)——偶爾晚一點(diǎn)后果可控用戶能接受。但急救車的調(diào)度通道不一樣救護(hù)車出發(fā)晚一分鐘可能直接影響搶救結(jié)果這個(gè)延遲是絕對(duì)不能被容忍的這就是硬實(shí)時(shí)。飛控計(jì)算機(jī)顯然是后者更準(zhǔn)確地說它是一輛要求每一毫秒都要精確踩點(diǎn)的“急救車”。從技術(shù)定義上說硬實(shí)時(shí)系統(tǒng)要求任務(wù)必須在截止時(shí)間Deadline之前完成哪怕只超一次也算系統(tǒng)失敗軟實(shí)時(shí)系統(tǒng)則允許偶爾錯(cuò)過截止時(shí)間只要平均性能過得去就行。這個(gè)定義差別帶來了完全不同的設(shè)計(jì)哲學(xué)通用操作系統(tǒng)比如桌面Linux、Windows追求吞吐量和公平性任務(wù)調(diào)度器會(huì)盡可能讓所有進(jìn)程都“有飯吃”但沒人能保證某個(gè)關(guān)鍵任務(wù)在10毫秒內(nèi)一定跑完而硬實(shí)時(shí)RTOS追求的是可預(yù)測(cè)性Predictability寧肯犧牲一點(diǎn)平均吞吐也要保證關(guān)鍵路徑上的行為時(shí)間是確定的。1.2 飛控為什么對(duì)實(shí)時(shí)性要求這么苛刻飛控計(jì)算機(jī)的工作模式大致是這樣一個(gè)閉環(huán)傳感器以固定頻率比如慣導(dǎo)200Hz、氣壓計(jì)50Hz、GNSS 10Hz產(chǎn)生數(shù)據(jù)飛控在每一個(gè)控制周期內(nèi)讀取這些數(shù)據(jù)、做姿態(tài)解算、運(yùn)行控制律PID、LQR、ADRC等等、輸出舵面/電機(jī)指令然后進(jìn)入下一個(gè)周期。這個(gè)循環(huán)一旦建立每個(gè)環(huán)節(jié)的延遲就都被“鎖”在了周期預(yù)算里。舉個(gè)例子假設(shè)控制周期是5ms200Hz那么從傳感器數(shù)據(jù)“新鮮可用”到指令輸出整個(gè)鏈路的延遲最好控制在2ms以內(nèi)剩余的3ms還要留給余量。如果操作系統(tǒng)調(diào)度不穩(wěn)定某次中斷響應(yīng)超時(shí)了200微秒傳感器數(shù)據(jù)晚到了控制律拿到的就是“過期面包”姿態(tài)回路出現(xiàn)相位滯后飛機(jī)在高速機(jī)動(dòng)時(shí)就會(huì)開始抖動(dòng)甚至發(fā)散。這不是理論推演我實(shí)際調(diào)過一架出現(xiàn)高頻振顫的固定翼最后定位到根因就是某個(gè)外部設(shè)備的共享中斷把飛控的主控制任務(wù)的響應(yīng)時(shí)間拉長(zhǎng)了——操作系統(tǒng)本身沒問題但實(shí)時(shí)保證被破壞了。所以飛控領(lǐng)域選RTOS本質(zhì)上是在選一個(gè)“行為可預(yù)期”的運(yùn)行環(huán)境。它并不需要什么花哨的調(diào)度算法而是需要任務(wù)切換時(shí)間確定、中斷響應(yīng)時(shí)間確定、同步原語不會(huì)導(dǎo)致優(yōu)先級(jí)反轉(zhuǎn)失控。這幾個(gè)點(diǎn)后面我會(huì)逐一展開。2. 常用硬實(shí)時(shí)操作系統(tǒng)橫向?qū)Ρ葮I(yè)內(nèi)常說的“飛控常用硬實(shí)時(shí)操作系統(tǒng)”其實(shí)是有代際和流派之分的。有人喜歡商用封閉生態(tài)的VxWorks有人擁抱開源Linux的RT補(bǔ)丁也有人在小飛控上跑FreeRTOS。沒有絕對(duì)的好壞只有合不合適的場(chǎng)景。這里按我自己的理解把它們分成三類傳統(tǒng)商業(yè)RTOS、準(zhǔn)實(shí)時(shí)Linux變體、輕量級(jí)開源RTOS。2.1 VxWorks老牌高可靠選手VxWorks在航空航天領(lǐng)域的歷史地位相當(dāng)穩(wěn)固很多成熟飛控產(chǎn)品、航電設(shè)備都跑在它上面。它最核心的優(yōu)勢(shì)有兩個(gè)一是微內(nèi)核設(shè)計(jì)內(nèi)核只提供任務(wù)調(diào)度、中斷管理、IPC這些最基礎(chǔ)的服務(wù)其他功能文件系統(tǒng)、網(wǎng)絡(luò)協(xié)議棧以組件方式加載這意味著核心執(zhí)行路徑很短、行為容易分析二是它的確定性調(diào)度非常成熟配合專用的分析工具可以對(duì)任務(wù)的WCET最壞執(zhí)行時(shí)間做比較嚴(yán)格的測(cè)算。實(shí)際用下來VxWorks的缺點(diǎn)是生態(tài)封閉、授權(quán)成本高、開發(fā)調(diào)試需要專門的IDE和環(huán)境。如果是做量產(chǎn)消費(fèi)級(jí)無人機(jī)或者小團(tuán)隊(duì)科研項(xiàng)目這個(gè)成本和門檻會(huì)顯得比較重。但如果做的是有人機(jī)飛控、衛(wèi)星姿軌控這類高安全等級(jí)系統(tǒng)VxWorks依然是穩(wěn)妥的選擇。2.2 RT-Linux / PREEMPT_RT把Linux改造成實(shí)時(shí)系統(tǒng)Linux本身是分時(shí)操作系統(tǒng)但這不影響它通過補(bǔ)丁變得“準(zhǔn)實(shí)時(shí)”。PREEMPT_RT補(bǔ)丁現(xiàn)在相當(dāng)一部分已經(jīng)合入主線內(nèi)核把Linux內(nèi)核里的不可搶占區(qū)間大幅縮小把中斷線程化讓實(shí)時(shí)任務(wù)的調(diào)度延遲從幾十毫秒壓縮到幾十微秒量級(jí)。很多新一代飛控尤其是基于高性能處理器、需要跑復(fù)雜導(dǎo)航算法的平臺(tái)會(huì)直接采用“Linux RT補(bǔ)丁 實(shí)時(shí)線程”的架構(gòu)。這套方案的好處是生態(tài)豐富調(diào)試方便你可以一邊跑著ROS/中間件做感知和規(guī)劃一邊用實(shí)時(shí)線程保證控制環(huán)的確定性。代價(jià)是它很難達(dá)到VxWorks那種嚴(yán)格意義上的硬實(shí)時(shí)保證因?yàn)長(zhǎng)inux內(nèi)核自身的復(fù)雜性仍然存在即使打了補(bǔ)丁最壞情況下的調(diào)度延遲也依然比商業(yè)RTOS要差一些而且這個(gè)“差”很難通過靜態(tài)分析完全證明。所以我的建議是對(duì)實(shí)時(shí)性要求沒那么苛刻、但計(jì)算復(fù)雜度很高的飛控任務(wù)比如視覺導(dǎo)航、SLAM控制融合用RT-Linux很合適對(duì)硬實(shí)時(shí)要求極端的任務(wù)還是把控制環(huán)放到專用RTOS上更安心。2.3 FreeRTOS / uC/OS / RT-Thread輕量級(jí)開源主力中小型飛控從穿越機(jī)到中小型多旋翼用得最多的還是輕量級(jí)RTOS。這里FreeRTOS幾乎是事實(shí)標(biāo)準(zhǔn)一方面它是開源免費(fèi)的另一方面它的內(nèi)核足夠精簡(jiǎn)任務(wù)切換和中斷響應(yīng)都能做到微秒級(jí)。uC/OS過去也很流行尤其是它的內(nèi)核源碼清晰、教學(xué)價(jià)值高現(xiàn)在一些新項(xiàng)目也會(huì)用RT-Thread因?yàn)樗脑O(shè)備驅(qū)動(dòng)框架和組件生態(tài)更適合做“帶豐富外設(shè)的復(fù)雜產(chǎn)品”。這類RTOS的特點(diǎn)是沒有MMU或者不啟用MMU、任務(wù)棧靜態(tài)分配、調(diào)度器簡(jiǎn)單直接。它們的目標(biāo)就是讓MCUSTM32、GD32這類飛控跑起多任務(wù)同時(shí)保留確定性的時(shí)間行為。比如在STM32F4上跑FreeRTOS把控制任務(wù)設(shè)為最高優(yōu)先級(jí)、周期5ms只要中斷優(yōu)先級(jí)配置得當(dāng)抖動(dòng)通??梢钥刂圃趲孜⒚胍詢?nèi)這對(duì)飛控已經(jīng)完全夠用了。2.4 QNX適合需要“硬實(shí)時(shí)POSIX”的場(chǎng)景QNX是另一款商業(yè)微內(nèi)核RTOS在汽車、醫(yī)療等強(qiáng)安全領(lǐng)域有廣泛應(yīng)用飛控領(lǐng)域相對(duì)少見但它有個(gè)獨(dú)特優(yōu)勢(shì)提供POSIX接口應(yīng)用代碼可以比較方便地遷移到Linux上同時(shí)保持硬實(shí)時(shí)能力。如果你構(gòu)建的飛控系統(tǒng)需要跑復(fù)雜的應(yīng)用層比如任務(wù)規(guī)劃、通信管理又想把這些子系統(tǒng)和硬實(shí)時(shí)控制環(huán)隔離QNX的分區(qū)機(jī)制很值得參考。當(dāng)然它的授權(quán)費(fèi)用和生態(tài)門檻決定它更適合高端工業(yè)無人機(jī)、飛行汽車這類預(yù)算充足的賽道。為了更直觀對(duì)比我整理了一張選型速查表大家可以當(dāng)作參考參數(shù)來自我自己的實(shí)測(cè)和公開資料系統(tǒng)實(shí)時(shí)性級(jí)別典型調(diào)度延遲生態(tài)/許可典型飛控場(chǎng)景VxWorks硬實(shí)時(shí)微秒級(jí)~幾十微秒商業(yè)、封閉高安全有人機(jī)、航電PREEMPT_RT準(zhǔn)硬實(shí)時(shí)/硬實(shí)時(shí)有爭(zhēng)議幾十微秒~百微秒開源高性能計(jì)算控制融合FreeRTOS硬實(shí)時(shí)微秒級(jí)開源免費(fèi)MCU中小型飛控uC/OS硬實(shí)時(shí)微秒級(jí)開源/商業(yè)雙許可教學(xué)/工業(yè)控制RT-Thread硬實(shí)時(shí)微秒級(jí)開源復(fù)雜外設(shè)需求的飛控產(chǎn)品QNX硬實(shí)時(shí)微秒級(jí)商業(yè)高端無人系統(tǒng)、飛行汽車注意同一套R(shí)TOS在不同硬件、不同中斷負(fù)載下調(diào)度延遲差異很大。表格里的“微秒級(jí)”只能代表典型范圍真正的實(shí)時(shí)性能必須結(jié)合具體平臺(tái)實(shí)測(cè)。3. 硬實(shí)時(shí)系統(tǒng)的關(guān)鍵機(jī)制拆解選好RTOS只是第一步真正讓飛控跑得穩(wěn)的是你如何使用操作系統(tǒng)提供的機(jī)制。這一節(jié)我把幾個(gè)經(jīng)常被忽視、但恰恰決定系統(tǒng)實(shí)時(shí)性能的底層機(jī)制講清楚。3.1 調(diào)度算法優(yōu)先級(jí)搶占只是及格線大多數(shù)輕量級(jí)RTOS采用固定優(yōu)先級(jí)搶占式調(diào)度Fixed-Priority Preemptive Scheduling任務(wù)在創(chuàng)建時(shí)分配一個(gè)優(yōu)先級(jí)內(nèi)核保證任何時(shí)候運(yùn)行的都是“就緒隊(duì)列里優(yōu)先級(jí)最高的任務(wù)”。聽起來很簡(jiǎn)單但這里面的門道在于你怎么確定每個(gè)任務(wù)的優(yōu)先級(jí)周期、執(zhí)行時(shí)間、截止時(shí)間之間是什么關(guān)系經(jīng)典的單處理器調(diào)度理論給出了一個(gè)可調(diào)度性判定條件。比如最常用的RMSRate Monotonic Scheduling單調(diào)速率調(diào)度原則周期越短的任務(wù)優(yōu)先級(jí)越高。如果一組任務(wù)的CPU利用率總和不超過某個(gè)上限n個(gè)任務(wù)時(shí)為 n(2^(1/n)-1)n趨向無窮大時(shí)趨近約69.3%則可以保證所有任務(wù)都在截止時(shí)間內(nèi)完成。換句話說如果處理器跑一組周期任務(wù)總負(fù)載超過約70%RMS策略就開始面臨無法保證所有任務(wù)按時(shí)完成的風(fēng)險(xiǎn)。這給飛控設(shè)計(jì)者一個(gè)很實(shí)用的直覺不要把一個(gè)核塞滿留出至少20%~30%余量否則任何一點(diǎn)抖動(dòng)都可能引爆截止時(shí)間違約。再進(jìn)一步EDFEarliest Deadline First在理論上是最優(yōu)動(dòng)態(tài)優(yōu)先級(jí)調(diào)度平均利用率理論上可以跑到接近100%但它需要內(nèi)核支持動(dòng)態(tài)優(yōu)先級(jí)調(diào)整且最壞情況下的行為分析更復(fù)雜。飛控項(xiàng)目里我很少見到直接商用EDF的——大多數(shù)人還是用固定優(yōu)先級(jí)搶占策略因?yàn)樗?jiǎn)單、可預(yù)測(cè)、分析工具成熟。3.2 優(yōu)先級(jí)反轉(zhuǎn)飛行控制里最隱蔽的殺手優(yōu)先級(jí)反轉(zhuǎn)是個(gè)經(jīng)典問題但實(shí)際項(xiàng)目里很多人直到炸機(jī)也沒搞明白。簡(jiǎn)單說高優(yōu)先級(jí)任務(wù)A等待一個(gè)信號(hào)量這個(gè)信號(hào)量被低優(yōu)先級(jí)任務(wù)B持有而B又被中優(yōu)先級(jí)任務(wù)C搶占——于是A明明優(yōu)先級(jí)最高卻只能等C先跑完相當(dāng)于A的優(yōu)先級(jí)被“反轉(zhuǎn)”到了C之下。飛控里典型場(chǎng)景是控制任務(wù)最高優(yōu)先級(jí)要通過串口/I2C總線讀取傳感器數(shù)據(jù)而一個(gè)低優(yōu)先級(jí)的日志任務(wù)恰好持有了總線驅(qū)動(dòng)里的互斥鎖。如果控制系統(tǒng)沒有用“優(yōu)先級(jí)繼承”或“優(yōu)先級(jí)天花板”協(xié)議那么控制任務(wù)可能被日志任務(wù)拖著延遲在微秒級(jí)到毫秒級(jí)之間劇烈波動(dòng)——這在姿態(tài)控制里就是災(zāi)難。排查這個(gè)問題的思路我在第5節(jié)會(huì)詳細(xì)展開。這里先記住一點(diǎn)你在用信號(hào)量/互斥鎖保護(hù)共享資源時(shí)一定要確認(rèn)RTOS內(nèi)核是否默認(rèn)支持優(yōu)先級(jí)繼承Priority Inheritance。FreeRTOS的互斥量是支持的普通信號(hào)量不支持VxWorks的互斥量默認(rèn)也可以配置。用錯(cuò)了對(duì)象實(shí)時(shí)性就沒了保障。3.3 中斷處理前一半必須“快進(jìn)快出”中斷響應(yīng)時(shí)間直接影響飛控對(duì)外部事件的反應(yīng)速度。硬實(shí)時(shí)內(nèi)核一般把中斷處理拆成兩部分中斷服務(wù)程序ISR只做最緊急的、和硬件強(qiáng)相關(guān)的收尾然后立刻喚醒一個(gè)高優(yōu)先級(jí)任務(wù)通常是 deferred interrupt handler / bottom half去做剩余工作。這種“快進(jìn)快出”的設(shè)計(jì)是為了最大限度地減小中斷關(guān)閉時(shí)間。比如PWM捕獲中斷里只記錄時(shí)間戳、置一個(gè)標(biāo)志位姿態(tài)解算則放在主控制任務(wù)里完成。如果反其道而行之在ISR里做大量運(yùn)算不僅拉長(zhǎng)了本任務(wù)的占用時(shí)間還可能導(dǎo)致其他同樣重要的中斷被阻塞——在飛控這種中斷密集的系統(tǒng)里這是調(diào)度延遲的主要來源。另外需要注意中斷嵌套的配置。Cortex-M系列MCU可以設(shè)置搶占優(yōu)先級(jí)分組如果飛控里多個(gè)外部中斷定時(shí)器、DMA、外部信號(hào)之間互相搶占設(shè)計(jì)不好會(huì)出現(xiàn)“低優(yōu)先級(jí)中斷被高優(yōu)先級(jí)風(fēng)暴餓死”的怪象。我通常把控制周期定時(shí)器的中斷優(yōu)先級(jí)設(shè)為最高NVIC搶占優(yōu)先級(jí)0DMA搬運(yùn)其次外部通信再次并把用戶自定義的軟件中斷優(yōu)先級(jí)涂低——保證控制環(huán)路的節(jié)奏永遠(yuǎn)不被其他事件打亂。3.4 時(shí)間管理系統(tǒng)的心跳與任務(wù)的心跳RTOS的時(shí)間管理核心是Tick系統(tǒng)節(jié)拍。內(nèi)核靠Tick來進(jìn)行時(shí)隙調(diào)度、延時(shí)管理、超時(shí)檢測(cè)。Tick頻率越高時(shí)間精度越高但內(nèi)核的上下文切換開銷也隨之升高。飛控里常用的是把Tick設(shè)為1kHz1ms再輔以更高精度的硬件定時(shí)器比如TIM專門做PWM同步來驅(qū)動(dòng)控制周期。這樣既照顧了操作系統(tǒng)的通用延時(shí)需求又保證了控制環(huán)的高精度時(shí)基。還有個(gè)容易被忽略的點(diǎn)Tick中斷里的累積誤差。如果內(nèi)核在處理Tick時(shí)總是調(diào)用一個(gè)耗時(shí)的鉤子函數(shù)比如喂看門狗、做統(tǒng)計(jì)Tick周期就會(huì)漂移進(jìn)而影響所有依賴系統(tǒng)Tick的軟件定時(shí)器。我習(xí)慣把Tick鉤子函數(shù)保持為空看門狗喂食放在單獨(dú)的低優(yōu)先級(jí)任務(wù)里做防止時(shí)間基線被污染。4. 從選型到實(shí)現(xiàn)我的飛控遷移實(shí)操記錄這一節(jié)我想用一個(gè)實(shí)際發(fā)生過的項(xiàng)目作為主線把某小型飛控從裸機(jī)前后臺(tái)模式遷移到RTOS同時(shí)把硬件定時(shí)器驅(qū)動(dòng)、任務(wù)劃分、通信同步都重做了一遍。整個(gè)過程踩了不少坑但最后形成的架構(gòu)模式后來被團(tuán)隊(duì)復(fù)用到了三個(gè)不同機(jī)型上。4.1 任務(wù)如何劃分優(yōu)先級(jí)怎么釘死裸機(jī)時(shí)代飛控主循環(huán)里依次執(zhí)行“傳感器讀取→姿態(tài)解算→控制律→指令輸出”看起來簡(jiǎn)單但一旦加入數(shù)據(jù)鏈、日志、故障診斷等模塊主循環(huán)會(huì)被嚴(yán)重拖垮。遷移到RTOS后第一步是盤點(diǎn)所有功能模塊按周期和截止時(shí)間劃分任務(wù)。我當(dāng)時(shí)的劃分方式如下控制任務(wù)最高優(yōu)先級(jí)周期1ms讀取IMU原始數(shù)據(jù)、互補(bǔ)濾波/姿態(tài)解算、角速度環(huán)和姿態(tài)環(huán)控制律計(jì)算、輸出PWM。導(dǎo)航任務(wù)次高優(yōu)先級(jí)周期10ms讀取GPS/磁力計(jì)/氣壓計(jì)執(zhí)行位置環(huán)解算、航點(diǎn)邏輯。通信任務(wù)優(yōu)先級(jí)中等周期10ms/事件觸發(fā)MAVLink數(shù)據(jù)幀解析與組裝地面站鏈路收發(fā)。日志任務(wù)優(yōu)先級(jí)低周期100ms或事件觸發(fā)把關(guān)鍵狀態(tài)量寫入SD卡/Flash。故障診斷任務(wù)最低優(yōu)先級(jí)周期200ms檢查傳感器健康狀態(tài)執(zhí)行看門狗喂食異常時(shí)觸發(fā)保護(hù)邏輯。每個(gè)任務(wù)的棧大小要根據(jù)調(diào)用深度和局部變量估算不能貪省。尤其是通信任務(wù)如果用了標(biāo)準(zhǔn)庫printf、浮點(diǎn)格式化這類重操作棧給小了分分鐘溢出。我一般會(huì)預(yù)留30%以上的余量再用內(nèi)核提供的棧高水位檢測(cè)工具在滿負(fù)荷跑一段時(shí)間后檢查實(shí)際峰值。4.2 通信同步數(shù)據(jù)從傳感器到控制器的鏈路飛控?cái)?shù)據(jù)流本質(zhì)上是“生產(chǎn)者-消費(fèi)者”模型。傳感器中斷/DMA把數(shù)據(jù)寫進(jìn)緩沖區(qū)控制任務(wù)周期性地來取。這里最關(guān)鍵的是保證數(shù)據(jù)的一致性——不能出現(xiàn)控制任務(wù)讀到一半傳感器DMA又在更新同一片緩沖區(qū)導(dǎo)致數(shù)據(jù)“撕裂”。我常用的方案是雙緩沖Double Buffering加Buffer標(biāo)志位切換傳感器DMA寫完Buffer A后在中斷里原子地切換“當(dāng)前有效緩沖”指針到A同時(shí)清掉舊的標(biāo)志控制任務(wù)開始讀取前先獲取當(dāng)前有效指針讀取過程中禁止切換讀完再釋放。用FreeRTOS的話更規(guī)范的做法是任務(wù)級(jí)同步用二值信號(hào)量DMA中斷里give信號(hào)量控制任務(wù)里take信號(hào)量同時(shí)配合內(nèi)存屏障保證數(shù)據(jù)可見性。這里有個(gè)細(xì)節(jié)信號(hào)量take的超時(shí)時(shí)間一定要設(shè)置成有限值不要用無限等待否則一旦傳感器故障不再產(chǎn)生中斷控制任務(wù)就會(huì)永久掛起飛控直接失控。4.3 真實(shí)代碼示例FreeRTOS下的定時(shí)控制任務(wù)下面這段代碼是我在某個(gè)STM32F405飛控上實(shí)際用過的控制任務(wù)骨架展示了一個(gè)周期為1ms的控制循環(huán)如何與定時(shí)器中斷配合// 控制周期定時(shí)器中斷服務(wù)函數(shù)TIM61ms周期 void TIM6_IRQHandler(void) { BaseType_t xHigherPriorityTaskWoken pdFALSE; if (__HAL_TIM_GET_FLAG(htim6, TIM_FLAG_UPDATE) ! RESET) { __HAL_TIM_CLEAR_FLAG(htim6, TIM_FLAG_UPDATE); // 給控制任務(wù)一個(gè)二值信號(hào)量通知其“新的控制周期到了” xSemaphoreGiveFromISR(xControlLoopSemaphore, xHigherPriorityTaskWoken); portYIELD_FROM_ISR(xHigherPriorityTaskWoken); } } // 控制任務(wù)函數(shù) void ControlLoopTask(void *argument) { TickType_t xLastWakeTime xTaskGetTickCount(); for (;;) { // 在信號(hào)量上等待周期信號(hào)等待時(shí)間可以設(shè)長(zhǎng)一點(diǎn)作為安全兜底 if (xSemaphoreTake(xControlLoopSemaphore, pdMS_TO_TICKS(10)) pdPASS) { // 1. 讀取IMU數(shù)據(jù)最新數(shù)據(jù)由DMA搬運(yùn)到雙緩沖區(qū) imu_update_reading(); // 2. 姿態(tài)解算互補(bǔ)濾波或卡爾曼濾波 attitude_estimate(); // 3. 控制律解算 control_calculate(); // 4. 輸出PWM pwm_output_update(); } else { // 超時(shí)未等到中斷傳感器/定時(shí)器鏈路可能異常 safety_trigger(SAFETY_CONTROL_TIMEOUT); } } }關(guān)鍵點(diǎn)不要用xTaskDelayUntil去“生成”控制周期——雖然也能實(shí)現(xiàn)周期調(diào)度但它的精度完全依賴RTOS Tick而Tick在中斷繁忙時(shí)可能有不可忽略的抖動(dòng)。用硬件定時(shí)器中斷驅(qū)動(dòng)控制周期的精度要高得多這也是飛控實(shí)時(shí)性設(shè)計(jì)的標(biāo)準(zhǔn)做法。4.4 移植之后一定要做的裸機(jī)沒有的驗(yàn)證從裸機(jī)切到RTOS之后很多隱藏問題會(huì)被多任務(wù)調(diào)度“放大”出來。我強(qiáng)烈建議做以下幾項(xiàng)測(cè)試任務(wù)切換總耗時(shí)測(cè)試在GPIO上翻轉(zhuǎn)一個(gè)引腳測(cè)量高優(yōu)先級(jí)任務(wù)從就緒到手頭代碼實(shí)際執(zhí)行的延遲。這個(gè)指標(biāo)直接反映RTOS和BSP配置是否健康。最大禁中斷時(shí)間測(cè)試用定時(shí)器測(cè)量?jī)?nèi)核或驅(qū)動(dòng)里最長(zhǎng)的一次關(guān)中斷時(shí)間。如果某驅(qū)動(dòng)在臨界區(qū)里干了太久比如超過幾十微秒控制任務(wù)優(yōu)先級(jí)再高也沒用。長(zhǎng)期壓力測(cè)試讓飛控連續(xù)運(yùn)行數(shù)小時(shí)周期性記錄每個(gè)任務(wù)的執(zhí)行時(shí)間統(tǒng)計(jì)值最小/最大/平均觀察是否有任務(wù)執(zhí)行時(shí)間逐漸增長(zhǎng)的趨勢(shì)——這通常是看門狗喂食邏輯異常或者內(nèi)存碎片導(dǎo)致的慢性病。5. 常見問題與排查技巧實(shí)錄這節(jié)內(nèi)容全部來自我真實(shí)開發(fā)過程中的排查記錄不是從文檔里抄的。問題可能看起來五花八門但根子往往都出在那幾個(gè)核心機(jī)制上。5.1 問題一控制任務(wù)偶發(fā)超時(shí)周期抖動(dòng)忽大忽小癥狀任務(wù)周期平均很準(zhǔn)但每隔幾十秒會(huì)出現(xiàn)一次10倍于正常周期的超時(shí)。一開始懷疑是任務(wù)棧溢出抓了高水位監(jiān)控沒問題后來懷疑是內(nèi)存分配malloc導(dǎo)致阻塞但代碼里改用靜態(tài)內(nèi)存后問題仍在。最后定位一個(gè)低優(yōu)先級(jí)通信任務(wù)里用了庫函數(shù)對(duì)字符串做了處理這個(gè)庫內(nèi)部會(huì)調(diào)用一個(gè)慢速的全局鎖類似printf的實(shí)現(xiàn)鎖的持有時(shí)間在高負(fù)載下變得很長(zhǎng)而通信任務(wù)和某個(gè)中優(yōu)先級(jí)任務(wù)之間有優(yōu)先級(jí)反轉(zhuǎn)鏈把控制任務(wù)也牽連進(jìn)去了。解決方案把通信任務(wù)里的所有“重”如日志格式化、浮點(diǎn)轉(zhuǎn)字符串操作拆出去只在里面做協(xié)議解析的輕量部分同時(shí)給通信任務(wù)使用的互斥量打開優(yōu)先級(jí)繼承。改造后抖動(dòng)從幾百微秒降到了幾微秒。5.2 問題二中斷里做耗時(shí)操作導(dǎo)致控制周期漂移癥狀飛行中姿態(tài)偶爾出現(xiàn)“毛刺”分析日志發(fā)現(xiàn)姿態(tài)解算結(jié)果的執(zhí)行周期前偶爾有一段約幾百微秒的空白正好落在某個(gè)外設(shè)中斷的活躍窗口里。原因外設(shè)中斷的ISR里為了省事直接調(diào)用了HAL庫的阻塞式等待函數(shù)這段等待在低功耗模式下要持續(xù)幾百微秒期間控制周期的定時(shí)器中斷被懸置了。雖然定時(shí)器中斷優(yōu)先級(jí)更高但對(duì)方已經(jīng)進(jìn)入不可被搶占的執(zhí)行區(qū)間。解決方案ISR里禁止任何阻塞型調(diào)用把“等待外設(shè)就緒”的邏輯改成狀態(tài)機(jī)輪詢放到非實(shí)時(shí)任務(wù)里執(zhí)行。同時(shí)給出了一個(gè)原則ISR只做置標(biāo)志、讀寄存器、收數(shù)據(jù)不等待、不循環(huán)、不調(diào)用RTOS的阻塞API。這個(gè)原則后來寫進(jìn)了團(tuán)隊(duì)代碼規(guī)范。5.3 問題三臨界區(qū)過長(zhǎng)導(dǎo)致中斷丟失癥狀外部遙控器信號(hào)接收中斷偶爾丟包地面站看RSSI正常但飛控收到的通道值偶發(fā)卡頓。原因某個(gè)驅(qū)動(dòng)在進(jìn)入臨界區(qū)taskENTER_CRITICAL后調(diào)用了一個(gè)執(zhí)行時(shí)間很長(zhǎng)的函數(shù)比如一個(gè)軟件I2C的bit-bang循環(huán)導(dǎo)致遙控接收中斷在這段臨界區(qū)期間被屏蔽數(shù)據(jù)幀丟失。解決方案把臨界區(qū)改小I2C讀取改用硬件I2CDMA ISR喚醒徹底去掉長(zhǎng)臨界區(qū)。這也是RISC-V/ARM內(nèi)核CPU上跑RTOS時(shí)的經(jīng)典教訓(xùn)臨界區(qū)是中斷的敵人能多短就多短。5.4 問題四內(nèi)存碎片導(dǎo)致任務(wù)棧分配失敗癥狀系統(tǒng)運(yùn)行數(shù)天后某個(gè)周期性創(chuàng)建的任務(wù)比如臨時(shí)數(shù)據(jù)鏈路線程突然創(chuàng)建失敗看門狗復(fù)位后一切恢復(fù)正常循環(huán)往復(fù)。原因任務(wù)棧用的是動(dòng)態(tài)內(nèi)存分配heap運(yùn)行過程中頻繁創(chuàng)建/刪除任務(wù)產(chǎn)生外部碎片最終導(dǎo)致一次大塊內(nèi)存分配失敗。解決方案兩種典型處理——要么把這類任務(wù)改成永久任務(wù)信號(hào)量觸發(fā)推薦要么啟用靜態(tài)任務(wù)創(chuàng)建APIxTaskCreateStatic把棧放在固定的靜態(tài)數(shù)組里。飛控系統(tǒng)里我后來幾乎全部改用靜態(tài)棧動(dòng)態(tài)分配只用于啟動(dòng)階段運(yùn)行期不再分配。為了便于日常自查這里也給一張速查表覆蓋我反復(fù)遇到的高頻問題現(xiàn)象可能根因排查切入點(diǎn)高優(yōu)先級(jí)任務(wù)偶爾延遲優(yōu)先級(jí)反轉(zhuǎn) / 中斷嵌套過深檢查信號(hào)量是否開啟優(yōu)先級(jí)繼承抓調(diào)度延遲的波形控制周期抖動(dòng)大Tick不準(zhǔn) / 臨界區(qū)過長(zhǎng) / 某中斷執(zhí)行時(shí)間過長(zhǎng)測(cè)量Tick波形檢查臨界區(qū)調(diào)用鏈傳感器數(shù)據(jù)“撕裂”共享緩沖未用雙緩沖/原子切換檢查DMA中斷與控制任務(wù)之間的同步機(jī)制任務(wù)棧溢出棧分配過小/局部變量過大/庫函數(shù)吃棧用內(nèi)核的棧高水位檢測(cè)抓峰值系統(tǒng)運(yùn)行數(shù)天后復(fù)位內(nèi)存碎片 / 看門狗喂食被阻塞檢查動(dòng)態(tài)內(nèi)存分配頻度檢查低優(yōu)先級(jí)任務(wù)是否餓死中斷響應(yīng)普遍變慢禁中斷區(qū)間過長(zhǎng) / 中斷優(yōu)先級(jí)配置不當(dāng)用示波器抓GPIO翻轉(zhuǎn)測(cè)ISR響應(yīng)時(shí)間排查這些問題的工具我推薦幾個(gè)思路一是用邏輯分析儀或示波器配合GPIO翻轉(zhuǎn)標(biāo)記在關(guān)鍵路徑任務(wù)入口、ISR入口、任務(wù)出口前后打點(diǎn)直接測(cè)出時(shí)間線二是用RTOS內(nèi)核自帶的統(tǒng)計(jì)功能比如FreeRTOS的task statistics、VxWorks的WindView把每個(gè)任務(wù)的執(zhí)行時(shí)間、切換次數(shù)、棧使用情況記錄下來分析三是在代碼里埋循環(huán)計(jì)數(shù)器和時(shí)間戳日志輸出后用腳本離線分析抖動(dòng)分布。這三板斧基本能覆蓋絕大多數(shù)實(shí)時(shí)性疑難雜癥。我個(gè)人的體會(huì)是飛控的實(shí)時(shí)性問題絕大多數(shù)不是RTOS本身的缺陷而是應(yīng)用層把它“用壞了”。絕大多數(shù)疑似系統(tǒng)不穩(wěn)定的case最后都能回溯到優(yōu)先級(jí)設(shè)計(jì)不合理、臨界區(qū)過長(zhǎng)、ISR干重活這三大類原因。這提醒我們?cè)谧鱿到y(tǒng)設(shè)計(jì)的時(shí)候就要對(duì)任務(wù)模型、中斷設(shè)計(jì)、共享資源訪問做“實(shí)時(shí)性預(yù)分析”而不是等代碼寫完再調(diào)。這比選哪一個(gè)RTOS更重要——因?yàn)榧词鼓阌玫氖荲xWorks任務(wù)模型設(shè)計(jì)爛了也一樣救不回來反之即使只是FreeRTOS只要任務(wù)劃分、優(yōu)先級(jí)規(guī)劃、時(shí)間同步這些基本功扎實(shí)它也能撐起一架非常穩(wěn)的飛控。另外補(bǔ)充一個(gè)后續(xù)可以繼續(xù)玩的方向隨著飛控越來越復(fù)雜單核MCU開始不夠用了雙核/多核AMP非對(duì)稱多處理方案逐漸流行——比如用Cortex-M7負(fù)責(zé)控制環(huán)Cortex-M4負(fù)責(zé)通信和日志兩個(gè)核各自跑一套R(shí)TOS通過共享內(nèi)存和核間中斷通信。這個(gè)架構(gòu)能把硬實(shí)時(shí)和繁重IO分開但核間通信的同步、緩存一致性、資源歸屬每一樣都是新的坑。有興趣的朋友可以從“為每個(gè)核分配獨(dú)立的實(shí)時(shí)域”這個(gè)思路切入去研究這個(gè)方向做好了比單純追求更高主頻有意義得多。
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
www九月婷婷| 五月丁香亚洲校园欧美| 91精品久久久久久久| 色婷婷97| 欧美成人猛片AAAAAAA| 五月婷婷丁香av| 超级碰碰碰久久网站| www,色色色网站| 五月婷婷激情日本| 99超级碰免费视频| 丁香五月乱中文字幕| 六月激情丁香一道本7777| 五月婷婷天| 99久久新视频| 亚洲五月婷婷| 亚洲操b| 99爱爱网| 99亚洲视频| 丁香婷婷丁香五月欧美人| 99视频| 色色色9| 超碰无码318604| 色人久久| 五月婷婷久草在线视频综合| 色久九| 天天干天天做| 色婷婷丁香五月| 99久久精| 国产精品黑丝| 欧美日综合| 99久久综合网| 婷婷射综合| 九九这里只有精品| 色欲久久久久久综合网综合网| 区区久久妻| 六月丁香网| 色婷婷色婷婷五月| 婷婷第六色| 久久久久9久无码视频| 天天操婷婷| 五月丁香免费视频| 9 1大香蕉| 五月丁香啪啪啪| 深爱开心激情网| 欧美婷婷综合| 99精品视频在线观看| 婷婷五月天电影区小说区| 激情九月综合| 大香蕉久久久久久久久| 婷婷五月成人| 97碰碰视频在线观看免费| 婷婷丁香五月天综合网| 婷婷久久丁香五月| 开心婷婷五月综合| 久久综合激情| 天天操夜夜操| 夜夜操天天爽| 梁铮版蜘蛛女在线观看| 婷婷狠狠18禁久久| 亚洲正能量欧美| 五月婷婷av| 日韩激情人伦人| 天堂在线9| 亚洲视频在线观看| 激情五月婷婷丁香| 日韩在线一级| 色5月婷婷| 91ncom.色| 两性婷婷丁香五月| 五月婷婷色| 五月天亚洲综合网| 第六色在线| 9久热在线视频精品| 综合AV网| 色婷婷av在线观看| www.色五月| 丁香五月综合在线观看| 亚洲综合干| 久久99久久99精品,久国产,久久精品免费,99久在线,久久久久国产精品免费网站,9 | 日韩999| 殴美97色| 五月色影院| 亚洲蜜桃精久久久久久久久久久久| 丁香五月色五月| 深爱1激情网| 5月婷婷6月六月丁香| 成熟妇人A片免费看网站| 久久女婷| XX久久| 99精品国产在热久久| 日本天堂免费99| 99色播| 婷婷永久在线| 91porn一起草| 五月色丁香婷婷综合| 激情五月天色色网| 亚洲性爱电影| 亚洲婷婷免费| 人人做人人看人人摸| wwwss在线观看| 色婷婷文字幕| 婷婷六月丁综合| 九九碰九九爱97超| 99精品一二三四视频| 五月天色裸体视频| 久久黄色免费视频| 日韩色色小视频| 依人大香蕉在钱1| 亚洲日日日| 狠狠干无码| 丁香五月婷婷久久久| 99视频精品| 色婷婷777狠狠| 婷婷五月天AV| WWW.桔色成人.COM入口| 九九爱激情| 亚洲Av入口| 色五月超碰| 六月丁香六月婷婷欧美| 人妻久久久久久久久妻久久久久久久久 | 亚洲色色图片| 大香蕉人妻| 熟女91九色| 成人在线免费网址| 中文字幕高清av| 婷婷最新地址| 少妇性BBB搡BBB爽爽爽视頻 | 日韩性爱AV| 精品无码久久久久久久久| 婷婷激情六月| 婷婷性爱| 中文字幕网伦射乱中文| 日韩性爱AV| 五月婷婷丁香综合| 狠狠五月综合在线| 色久五月天| 天天色天天爱天天爽| 开心婷婷五月花| 九九日本视频| 人人色性网| 丁香婷婷免费| 天天日夜夜夜操操操操| 激情小说 五月天| 99.色| 五月丁香婷中文字幕| 美女100%露全身无挡网站| 国产精品噜噜在线视频| 天天橾日日橾夜夜橾17| 天天天久久人人人合| 婷婷丁香五月高清| 久久超视频| 欧美三日本三级少妇三99| 丁香六月婷| 淫视馆AV在线| 五月丁香亭亭| 黄网在线免费观| 大香伊人久色| 丁香色影院| 熟女91九色| 人人性久久| 97婷婷丁香| 大香蕉婷婷五月天| 色A网| 欧美色骚婷婷五月天| 婷婷五月天成人动漫 | 久久成人性爱| 就爱射中文字幕资源网| 丁香五月婷婷基地| 色视五月天婷婷| 激情亚洲色图片丁香综合| 色五月婷婷开心| 五月丁香激情六月| 五月丁香六月婷婷成人电影| 亚洲综合色网| 日本三级99人妇网站| 亚洲国产成人AV在线| 99碰碰中文| 天堂成人久久| 熟女激情网| 丁香五月狠狠综合欧美| 荷兰av一级| 九九99免费视频| a久久| 99精品网| 色色色天堂网| 思思久久99热| 久久久久久五月天| 婷婷五月综合在线| 婷婷六月综合激情| 五月天色小说| 91凹凸在线| 无码四色色色| 欧美激情五月天在线观看| 99热777| 亚洲丁香五月天视频| 综合久久97| 人妻av在线| 99综合五月免费视频色婷婷| 99热99久久| 超碰免费成人| 9999热这里只有精品| 五月婷六月| 色99自拍| 99在线免费观看| 噜噜精品| 日本色色色| 成人亚洲精品久久久久| 久青操| 视色网在线播放| 丁香六月伊人| 色色色色综合网| 七七久久婷婷| 99丁香五月婷| 久久婷婷五月天激情四射| 亚洲avjiujiur91| www.五月瑟| 成人婷99最新| 97超碰9久热婷婷热| www.久久久久久久| 人妻操在线看| 婷婷91| 大香蕉在九| 色色色在线| 五月天婷婷午夜丁香| xxx.色婷婷| www.日韩国产| 性生生活大片又黄又| 91精产品自偷自偷综合| 精品九九视频| 99精品自拍视频| 激情九月婷婷九月| 九九热99re8热免费观看| 婷婷激情5月| 婷婷五月大香蕉| 伊人高清无码| ay2区| 久热久色| 丁香五月激情综合| 99热 日韩| 久99在线视频| 丁香五月天色| 九九热欧美| 色婷婷五月综合激情中文字幕| 91玖玖| 丁香六月色婷婷| 狠狠干综合| 香蕉大综综综合久久| 天天做天天干天天综合网 | 婷婷狠狠五月综合| www.激情| AV在线免费播放| 久久婷婷亚洲五月天| 亚洲天堂99| 精品9l九九九九九77777| 另类五月婷婷| 91久久久久久久久久久| 99人人操人人操人人精| 99操逼| 九九色99| 日本九九视频| 色婷婷亚洲六月婷婷中文字幕| 天天干天天插| 九九99免费视频| 色婷婷五月综合| 99免费超碰在线| 激情综合网丁香| 色色色无码| 五月丁香亭亭| 人妻中文在线| 久综合| 日韩AV免费| 天天操天天操综合| 99re在线观看| 婷婷五月天免费99| 26uuu淫色| 涩综合网| 久久伦乱| 日日操夜夜爽| 成人人操| 亚洲激情五月| 99re视频在线| 五月丁香色| 综合色在线| 色播丁香五月婷婷操:屄| 久99热| 婷婷激情综合色五月久久图片| 伊人超碰| 色五月综合网| 丁香婷婷五月激情综合| 久久性爱视频| 综合亚洲五月天| 久久婷婷五月| 久久久中文| 激情综合在线观看| 色婷婷欧美| A1片久久久| 狠狠色狠狠爱| 欧美A级网站| 九九re精品视频在线观看| 丁香操逼| 色噜噜婷婷| 五月丁香婷婷钟和色图| 色丁香婷婷| 在线免费视频caop| www.99成人视频| 另类图片天天影视在线观看| 欧美在线视频99| www激情| 99热在线看| 狠狠色综合精品视频在线| 亚洲超碰青涩| 五月丁香淫淫婷婷婷| 五月婷婷婷色| 婷婷丁香五月色| 中文字幕成人日韩| 五月婷婷丁香五月婷婷丁香| 欧美日韩999| 另类的婷婷| 久久五月丁香| 《诡秘之主》在线观看| 亚洲婷婷五月天| 亚洲亚洲激情| 亚洲欧洲中文日韩久久AV乱码| 婷婷五月天亚洲色| 亚洲一区二区色图-亚洲精品国产精品乱码-成人AV | 久久久噜噜噜www成人| 狠狠色综合精品视频在线| 爆乳熟女-区二区三区| 欧美人妻一区二区| 人妻久久婷婷| 精品人妻一区二区三区四区不卡在| 久色网| 欧美色五月| 91天天操天天干天天射| 天天爽天天| 丁香五月六月婷婷自拍| 丁香五月色激情| www,天天干| 99碰| 久久激情五月| 五月婷婷之激情五月| 亚洲av电影网站| 夜夜夜夜夜骑撸| 99亚洲精美视频在线观看| 九九久久99精品免费观看www| 婷婷伊人网| 丁香成人五月天| 激情五月天婷婷久久久久久久久久久| 青柠影视免费高清电视剧| 激情综合网激情五月丁香| 亚洲国产色婷婷| 伊人婷婷色| AV九九| 狠狠操狠狠| 五月婷婷综合色拍| 国产婷婷五月| 久久九九免费视频| 射久久丁香五月| 亚洲无码激情| 五月婷婷色综图片| 婷婷五月激情热播| 夜夜爽77777妓女免费下载| 思思热在线视频99| 狠狠一日| 大战熟女丰满人妻AV| 综合性爱网| 亚洲成人在线播放| 五月婷久久| 成人国产欧美大片一区| 国产亚洲色婷婷久久99精品91| 99re免费精品视频| 国外亚洲成AV人片在线观看| 99热这里只有精品16| 9久久婷婷国产综合精品性色| 日本五月婷婷| 久久A V无码视频| 生活片五区| 色综合婷婷| 五月天色导航| 国产精品视频免费看| 五月天婷婷久久| 五月婷婷基地| 五月天婷婷爱| 国产精品VIDEOSSEX久久发布| 九九热这里只有精品在线观看| 天天色综| 五月丁香色综合| 狠狠色综合精品视频在线| 91人人人人人人人| 图片区 小说区 区 亚洲五月| 丁香五月婷婷激情97| 色情综合网| 色99热| 黄色AV日韩| 日本久久高清| www.com.色色| 被强行糟蹋的女人A片| 久久久久久久久人妻| 97热久久| 99ER热精品视频| 99超级碰碰| 丁香九月综合| 亚洲色五月婷婷| 91超级碰碰| 亚洲男女激情| 另类激情五月| 玖玖爱综合网| 色婷婷无吗| 99爱精品| 丁香激情网| 丁香五月天欧美| 97人人操人人| 成人AV综合在线| 亚洲无码99| 激情五月天啪啪| 五月天激情国产综合AV| 操一区| 久久99免费视屏| 国产亚洲精品久久久久久豆腐| 色五月综合资源推荐| 亚洲无码成人网| AV在线二十六页| 国产精品18久久久| 婷婷久热| 日本天天操| 丁香五月丁香伊人| 五月天开心激情网色欲无码| 久久狠狠干| 男人的天堂99| 538在线精品| 婷婷性爱| 久婷婷婷| 五月婷婷综合在线视频小说| 五月丁香婷婷激情| 激情综合婷婷五月| 九九九日本熟女| 野外99热| 1024在线一区| 99色| 亚洲久久激情| 久久性爱视频| 久久婷婷五月草视频| 欧美成人无码高清一区二区三区| 玖玖婷婷五月| 狠狠九九婷婷韩| 丁香五月激情久久麻豆| 内射在线CHINESE| 五月婷婷婷| 色你久久| WWW.桔色成人.COM| 久久婷婷成人综合色怡春院| www,五月天激情| 日本www五月婷婷| 五月丁香| 99视频久久| 日韩有码久久| 爱iii做iiii日| 亚洲视频在线观看| 五月丁香色综合| 天天爽夜爽| 日韩成人AV在线| 亚洲成人av在线播放| 欧美综合婷婷网| 极品色丁香| 婷婷五月丁香久久| 亚洲无码九九九| 五月激情综合婷婷| 久9热在线免费观看| 欧美 色婷婷| 中文字幕网伦射乱中文| 4399啪啪视频| 国产熟妇乱子伦hd| 日韩丁香涩| 婷婷五月天激情网| 色婷婷丁香五月| 超碰AV在线| 伊人激情啪啪| 99久re热视频精品98| 91人人网| 五月丁香影院| 久久xxxx| 综合激情五月婷婷| 色碰碰视频| 天天综合网91| 亚洲操逼网| 五月丁香色色网| 色色免费网站| 人人干av| 久久曰曰| 99精品偷自拍| 懂色av粉嫩AV蜜臀AV| 级人人91| 久久 中文 日本| 超级碰碰碰91| 久久与婷婷| 91ncm视频| 久久婷婷色情7777网站| 色狠狠色| 日本片日本片祼观看网站在线看中文版网页在线看 | 综合五月天亚洲婷婷| 婷婷激情综合无月| www.五月丁香av| 狠狠五月激情丁香六月| 激情99| 五月丁香六月婷婷色情| 丁香花五月天激情| 丁香五月综合| 精品一区二区三区免费毛片爱| 欧美性生交XXXXX无码小说| 国外亚洲成AV人片在线观看| 先锋影音男人的天堂AV| www.99精品视频| 五月天操逼网| 这里只有精品视频222| 老司机午夜福利视频金瓶梅| 操逼在线视频| 婷婷五月av| 久久婷婷五月综合激情国产| 婷婷狠狠干| 狼人久草| 色情五月天丁香社区| 四虎成人精品永久免费AV九九| 天天操比比| 久久精品A片777777| 爱穴久久| 噜噜色五月| 色哟哟精品| 九九国产视频| 五月欧美色色五月| 在线观看亚洲AV| 九九热在线视频观看| www.婷婷五月| 色婷婷伊人激情在线观看| 拍色综合| 日韩一级片| 天堂五月婷婷| 天天日天天干天天天| 99色精品| 五月天婷婷色色| 亚洲视频综合网| 五月丁香婷色| 久操无码| 婷婷日日天天| 丁香五月综合激情性爱| 久久久网站| 人人摸人人干| www.五月天婷婷| 精品五月丁香| 婷婷色五月天在线| 亚洲综合视频在线| 日产精品一线二线三线芒果| 婷婷久热| 久久曰9| 99热综合在线| Va另类视频| 99热网址| 91无码色色| 亚洲精品在线视频| 99热热九九| 婷婷五月六| 五月天综合| 999热在线观看视频| 97爱综合| 婷婷五日b| 五月婷婷花| 婷婷精品在线| 亞洲自怕| 色久婷婷五月| 在线只有精品| 国产又爽又猛又粗的视频A片| 天天操天天插天天射| 成人AV免费观看| 五月天欧美激情| 超碰97免费在线| 麻豆AV一区二区三区| 欧美激情久| 九九热只有精品6| 天天做天天爽| 大地9中文在线观看免费高清| 五月婷免费视频| 激情婷婷五六月天| 噜噜色噜噜网| 亚洲国产无线乱码在线观看| 亚洲无码黄色| 这里只有九九精品| www.婷婷五月| www.无码com| 26uuuavcom| 成人av在线电影| 日产精品一线二线三线芒果| 日本高清久| 丁香九月婷婷色| 色婷婷五月在线| Www.se.久久| 婷婷五月成年人| 97超碰在线免费观看| 综合色在线| 掩去也综合五月视频| 五月天婷婷乱论小说| 欧美激情综合五月色丁香| 日韩成人AV在线| 婷婷色正月| 精品国产乱码久久久久夜深人妻| 久久婷五月婷| 五月激情在线| 国产精品久久久久久喷浆| 丁香激情网| 黄色AAAAA| 无码人妻丰满熟妇奶水区码| 只有精品视频在线观看| 久久精彩视频| 天天爽天天| 久热欧美| 丁香五月婷婷影院| 色情综合网| 激情视频91| 免费观看欧美成人AA片爱我多深| 国产AV一区二区三区日韩| 亚洲操逼片| 天天草天天爽| 性欧美大战久久久久久久83| 国产激情综合五月| 久久丁香| 色碰碰视频| 日韩AAAAAAAAAAA片| 婷婷五月激情片| 伊人天天色| 欧美这里只有精品| 七七九色| 激情五月天色播| 丁香狠狠色婷婷久久无码视频| 九九精品片一| 婷婷五月色| 激情四射五月天| 五月婷婷丁香五月| 日韩AV中文字幕在线| 五月停停丁香| 激情性爱五月天网页| 九九99久久| www久久99| 欧美精品啪啪| www激情| 丁香婷婷五月综合欧美另类| 色欲资源网| 色婷网站| 99热精地址| 爱穴久久| 99视频只有这里精品| 日日躁夜夜躁狠狠久久AV| 色A网| www色色com| 日本久久婷婷| 午夜天堂啪啪| 五月天激情四射| 婷婷五月天AV| 国产亚洲99| 天天干天天操天天拍| 婷婷九月色| www.精品99| 亚洲综合在线网站| 五月99久久| 人妻中文av| 五月激情婷婷国产精品久久久久久 | 激情亚洲网| 婷婷情色开心五月天99| 丁香色情五月综合网站| 天堂呦 呦百度搜索-百度搜索| 狠狠草综合网| 免费色婷婷| 婷婷五月美女直播| 婷婷六月香| 综合五月天婷婷色| 丁香五月很很肏| 天天视频亚洲| 午夜日日| 婷婷五月天激情网| 五月天之色情综合网| 九九99香蕉在线视频播放| 日韩黄色网络| 欧美99| 色五月婷婷天天干| 久久久99精品免费观看| 台湾综合丁香五月蜜桃| 国产99久久久国产精品免费看 | 激情久久综合| 色色五月婷| 综合激情综合啪啪| 色婷婷亚洲综合天堂| 少妇达人正片在线播放_ikun_福利吧| 色婷婷aV四虎| 老司机日日夜夜青草| www热久久yy9| 思思热这里只有精品| 午夜激情四射影院| 五月天激情婷婷久久| 五月天三级久久| 婷婷久久综合| 五月激情久久综合| 91夫妻视频| 涩涩涩五月天| 丁香五月中文字幕| 狠狠操狠狠| 亚洲VA在线| 免费看片操逼| 久久久www| 狠狠va| 九月激情婷婷丁香| 激情五月婷婷丁香| 97欧美在线| www.99在线| 天天插天天插| 最近免费中文字幕大全高清大全1| 五月婷深深爱激情网| 日韩 mm 不卡| 久久六月天| 射满了还射免费在线观看 -午夜版全集-新视觉影院| 玖玖在线视频| 色五月六月婷婷| 久久99成人性爱高清视频| 我爱宗和色| 综合婷婷五月丁香在线观看| 亚洲午夜一区二区| 五月天婷婷激情在线色图| 日本色五月| 亚洲99综合| 五月丁香婷婷视频| 色综合丁香| 色五月婷婷在线视频| 国产精品色婷婷久久久精品| 激情色五月天| 九九九午夜影院成人| 亚洲视频伍月婷婷| 丁香五月日韩| 色欲九区| 操一区| 99视频只有这里精品| 97人妻碰碰碰久久香蕉| 91婷婷在线| 国产精品国产| 中文字幕av在线| 精品久久人妻热| 99久久精品网| 黄色三级日本| 疯狂做受XXXX高潮A片| 99视频这里只有免费精品| 99热午夜精品| 91久久婷婷| 五月成人网天天| 色综合久久天天综合网| 国产精产国品一二三在观看| 综激情网| 婷婷综合网站| www色色com| 国产人妻人伦精品一区二区| 久久久久人妻精品| 丁香五月激情站| 日韩精品电影| 六月丁香五月婷婷| 亭亭五月丁香五月天激情| 色婷婷婷av | 色婷婷婷av | 丁香婷婷综合精品六月初| 久久婷婷五月综合色和| 丁香五月婷婷影视先锋| 日本色频| 亚洲婷婷丁香| 色五月天 丁香| 九九热re99re6在线精品| 婷婷激情丁香五月婷婷激情丁香五月婷婷 | 激情五月丁香在线观看直播| 色色色综合色| av亚洲国产小电影| 九九成人电影婷婷| 五月做爱| 久草五月婷婷| 丁香婷婷免费| 日韩操逼大片| 99干视频| 99热手机在线精品| 婷婷五月天六月丁香| 丁香五月aV| 人妻久久久| 五月激情天| 99热中文字幕久久| 激情综合网五月丁香| 五月婷婷黄网站大全| 久久婷婷五月天激情新地址| 9l视频自拍九色9l视频自拍九色9l社区| 久久激情四射| 玖玖99福利| 五月丁香激| 免看黄大片AA | 五月婷六月| 亚洲va在线∨a天堂va欧美va| 夜夜做天天爽| 久久综合九九| 五月天丁香成人| 蜜乳AV成人| 九九热青草| 天天草天天爽| 97在线精品| WWW,五月| 五月丁香啪啪网| 韩国婷婷丁香五月| 五月婷丁香| 激情99热| 九九色色色| 久久精品噜噜噜成人A∨色欲| 操大屄五月天视频| 99精品视频在线观看| 婷婷五月天成人| 亚洲午夜AV| 狠狠穞A片一區二區三區| www.五月天社区| 人人天堂操| 美女婷婷六月色| 婷婷,五月天,丁香,第一| 婷婷情色五月天| 五月停停色| av中文网| 丁香网五月天| 久久综合99综合| 色噜噜狠狠色综无码久久合欧美| 狠狠操天天干| www.天天干| 狠狠狠狠狠干| 五月天成人综合| 深爱激情六月天| 爆乳熟妇一区二区三区爆乳照片| 天堂网啪啪| 深爱激情69热| 五月天精品综合| 久99热| 色丁香久久久| 亚洲五月婷天天操| 天天干天天日天天插| 侠女刀之记忆电影在线看免费| 婷婷丁香社区网| 婷婷综合欧美| 色婷婷婷av| 久/久精品99看9| 久久男人网婷婷| 无码色| 免费无码毛片一区二区A片| 五月婷视频| 丰满人妻一区二区三区| 夜色综合网| 五月天激情久久| WWW99热| 亚洲操精品| www天天色天天射| 五月天在线视频尤物视频在线看| wwwxxx五月婷婷小说| 激情五月天小说视频| 高清无码中文字幕aVDV| 日韩欧美骚货| 五月激情婷婷开心| 天天爽夜夜爽夜夜爽精品视频| 日狠狠| 影视av久久久噜噜噜噜噜三级| 婷婷午夜综合| 8区视频在线| 99九九视频| 开心五月天激情网| 综合色、色综合| 日韩熟女啪啪视频| 婷婷日韩| 草草影院爱爱| 婷婷激情五月视频| 亚洲精品影视| 天天日日人| 99热这里只有精品69| 伊人丁香婷婷东京| 欧美英丁香开心快乐六月天网| 丁香久色| 欧美啄木乌丝袜人妻系列| 六九色综合婷婷五月天| 大香蕉精品视频| 五月丁香五月综合欧美| 年轻的妺妺伦理HD中文| 男女激情久久| 97热九九| 五月天婷婷激情网| caopeng97日韩| 国产精品五月天婷婷| 五月丁香在线| 婷婷伊人网| 国产AV一区二区三区最新精品 | 国产成人高清| 日本人妻A片成人免费看片| 久久九九99| 中文AV网站| 国产激情在线| av婷婷丁香 六月| 色丁香久久久| 67194中文字幕| 成人av免费观看| 99国产在线精品视频| 人人操婷婷| av操一操| 另类的婷婷| 成人电影丁香六月天| 欧美日韩成人在线观看| 337p大胆噜噜噜噜噜91Av| 欧美十二区| 97资源碰碰在线| 激情五月天激情网| 九九爱激情| 日亚二欧美| www.99热这里只有精品| 大香蕉久久综合网| 久久伦乱| 好吊丝aV| 人人摸人人干| 五月丁香亭亭| 日韩精品电影| 丁香五月婷婷六月婷婷| 日日夜夜小色哥| 99爽视频| 99国产精品久久久久久久久久久 | 色五月AV| 日韩性爱AV| 欧美日韩精品一区二区三区钱| 超碰在线成人| 99热这里只有精品一区| 激情五月天啪啪| 国产成人精品123区免费视频| 婷婷久久婷婷| 蜜臀av无码久久久久久久久 | 丁香六月婷婷开心| 日日噜狠狠色综合久| 另类小说五月天| 99久高清视频| 丁香五月 综合| 开心深爱激情网| 日本一级一级一级一级| 99久久亚洲国产| 欧美色骚婷婷五月天| 天天舔天天摸| 国产午夜精品一区二区三区四区| 六月婷婷香蕉| 色五月av伊人| 色婷婷免费视频| 丁香六月婷婷色XXXX| 婷婷伊人久久| 五月婷婷六月少妇激情| 久久久婷婷婷| 丁香五月网| 色色婷婷综合网| 秋霞AV淫| 久久丁香婷| 538在线| 97色色网| 婷婷香蕉精品| 色色是色N一| 色噜噜狠噜噜视频| 97超碰婷婷五月天| 狠狠舔| 五月天婷婷激情综合| 中文字幕网伦射乱中文| 9久久久久| 亚洲色模骚货| 激情五月婷婷| 狠狠久久婷五月| 开心激情网在线| 五月丁香婷婷啪啪| 欧美五月婷婷综合| www.sd-xiangsu.cpm| 在线另类视频| 激情婷婷22月间| 丁香六月婷婷综合网| 亚洲欧洲另类| 久久久27操| 亚洲激情免费视频| 五月丁香影院| 色热久| 国产精品人人妻人人爽| 国产毛片精品一区二区色欲黄A片| 中文字幕综合网| 五月激情婷婷丁香天堂| 天天日天天久久青青| 九九国产精视频| 色婷婷小说网| 色播激情| AV美美午夜| 亚洲旡码| 色级婷婷| 天天摸日日舔狠狠添婷婷婷| 99热官网| 色人久夂| 99久热这里只有精品| 天天干天天日蜜臀av| 怡红院院在线导航网| 狠狠色丁香| 99干日本| 99性爱| 超碰99热在线观看| 99热精地址| 日本色五月| 91疯狂操操操操| 五月草视频| 超碰97在线观看免费| 亚洲综合干| 丁香五月影院| 亚洲色9| 97在线视频观看| 日本一级| 操97免费超级视频| 久久女人九九| 久久人妻视步| 五月婷婷综合成人| 五月丁香婷婷激情在线| 五月婷婷开心网| 亚洲一区国产传媒| 婷婷丁香五月激情密臀av| 大香婷婷| 婷婷六月啪啪| 亚洲AV电影美洲AV电影| 精品无码99| 丁香婷婷五月份| 婷婷丁香激情五月| 中文字幕乱码亚洲精品一区| 丁香五色月婷婷网| 激情五月天色播| 在线,国产,色,热视频| 丁香五月激情啪啪| 狠狠丁香| 五月婷婷丁香| 亚洲综合成人网| 五月香婷婷| 九月丁香| 五月婷婷中文| 国精产品一区二区三区| 色色色99| 激情五月综合第一页| 五月天婷婷成人| 99热精品超碰| 思思热在线观看| 99人人干人人| 96精品久久久久久久久| 久久激情五月天| 久久综合性| 91丨九色丨熟女高潮| 第四色五月天| 色六月天天激情综合网| 97天堂| 久久婷婷六月综合资源| 色综合天天综合成人网| 久色视频在线| 国产毛片精品一区二区色欲黄A片| 丁香五月天人体| 99∨VTV| RenRenSe在线视频网站| 婷婷丁香日韩五月| 国产精品蜜臀99| 婷婷五月激情四射手| 久久这里有精品视频在线免费观看| 九月婷婷人人操人人舔人人爱| 色五月婷婷影院| 无码橾| 五月婷婷久久久| 天天日天天做天天舔| 99九九视频| 噜噜噜噜噜日本视频| 国产成人综合亚洲| 婷婷开心久久| 先锋资源婷婷| 六月激情婷婷| 五月丁香啪啪啪免费看| 99视频只有精品| 婷婷五月天在婷| www.激情五月天.con| 婷婷月综合| 丁香丁婷五月激情| 亚洲亚洲人成综合网络| 天天高潮夜夜爽| 丁香五月婷婷少妇| 99爱视频| 亚州精品色情无码A片| 国产毛片精品一区二区色欲黄A片| 午夜精品777| 精品一区二区三区三区| 午夜成人网站在线观看| 丁香五月天欧洲在线| 婷婷D区| 久色婷婷200| 中文字幕在线免费| CHINESE熟女老女人HD视频| 色婷婷九月综合| 久久一级片| 色色综合网站| 日韩激情婷婷五月天| 九九综合九色欧美狠狠| 超级碰碰91| 久久99这里只有精品| 亚洲狠狠色丁香婷婷综合久久| 丁香五月六月激情久久| 狠狠色狠狠爱| 欧美婷婷综合| 天天狠狠色| 日本精品干| 九九久久综合| 成人免费va| 91久久久久久| 极品人妻VIDEOSSS人妻| 丁香成人五月天| 日日爱678| 99热在线观看| 人人摸人人干| 最新午夜理论片| 天天久久婷婷| 综合久| 深爱丁香激情| 九月丁香八月婷婷久久综合久97| 99热精品中文字幕| 日本激情五月天‘| 男人天堂99| 图片区 小说区 区 亚洲五月| 激情五月五月婷婷| 欧美色狠婷久| 奇米影视在线视频| www.激情| 99热这里有精品2| 热久国产| 成人超碰网| 五月天综合激情网| 伊人丁香婷婷东京| 91凹凸在线| 亚洲妇女熟BBW| 99这里只有精品99| www.婷婷| 久婷婷久草| 99re免费精品视频| 思思热在线视频99| 人妻激情在线| 婷婷伊人久久无码色五月| 玖玖爱资源站| 热99这里只有精品视频| 玖玖色综合网| 91色性感五月婷婷丁香| 色爱99| 人妻乱码久久久| 亚洲一级AV在线免费播放| 亚洲亚洲人成综合网络| 性色婷婷| 99热视精品| 五月天激情综合网俺也去| 微拍92| 色情综合网| 久操97| 玖玖福利视频资源| 影音先锋色色色资源色资源色| 欧美男女婷婷| 日韩精品AV一区二区三区| 99a级片| 五月婷婷激情综合拍| 大功率国产在线| 99五月婷| 99热国产免费| 天天干天天拍| 五月丁香五月天现场视频| 免费成人va| 97精品自拍视频| 亚洲精品久久久无码| 91九色丨国产丨爆乳| 色天天综合| 婷婷五月欧美综合| 色5月婷婷色| 亚洲一级 片内射网站在线观看| 99视频精品在线| 婷香五月激情视频| 欧美va| 99re这里只有精品9| 午夜激情久久| 日日干日日| 97九色视频| 亚洲va在线∨a天堂va欧美va| 狠狠狠人妻| 九九热在线观看6| 99在线视频免费| 91聚色综合网| 无码日本精品XXXXXXXXX| 九九大香视频| 天天色色天天| 丁香五月天激情小说| AV在线观看网站| 综合网网欲色| 99热人人艹| 性做久久久久久久免费看| 国产99热| 五月丁香六月激情| 丁香激情五月少妇| 激情五月婷婷综合网| 天天开心婷婷丁香五月| 免费播放片大片| 伊人婷婷99热精品| 欧美大片免费播放器| 色噜噜狠狠色综合日日| 五月天操逼激情| 99精品成人无码A片观看金桔| 婷婷五月色情天| 网站免费一站二站| 天天天操天天天日| 天天爽日日爽夜夜爽| 亚洲 在线 性爱| WWW丁香五月| 97色色综合| 性爱七区| 九九中文字幕九| 丁香五月婷婷激情蜜桃| 日韩啪啪视品| 色色色色色色综合网| A片试看50分钟做受视频| 五月丁香啪| 九九热精品| www.99热| 婷婷五月丁香六月| 综合图片色色| 婷婷金品综合视频| 逼逼AV| 五月激情婷婷六月丁香| 伊人丁香六月婷婷| 激情综合五月婷| 影音先锋噜一噜| 婷婷综合亚洲| 亚洲成人在线观看av| 婷婷色五月天色| 婷婷五月激情的图片| ss五月天激情| 激情五月六月婷婷| 91热在线| 久久久久久久久18久久| 五月婷婷深深爱| 久久99久久99精品免视看婷婷| 丁香五月网| 五月婷婷六月丁香综合| 国产毛多水多女人A片| 精品99视频| 婷婷国产日本欧美| 亚洲丁香五月天视频| 99热久| 久久全色| 亚洲 在线 性爱 | 婷婷五月激情视频网| 五月天激情综合首页| 九热视频这里只有精品| 亚洲激情av| 丁香五月婷婷Av| 五月色欧洲| 99无码视频| 丁香五月婷婷激情蜜桃| www.99热国产| 色综合激情| 大香蕉520| www.夜夜| 色色五月婷婷| 97色色色| 婷婷五月天激情四射| Av性爱网站| 天天干夜夜b| 欧美爆乳一区二区三区| 九九热思思| 婷婷丁香六月| 婷婷丁香熟妇综合网| 五月综合色| www.色五月|