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

ARTICLE DETAIL

資訊詳情

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

基于RT-Thread的CanFestival移植:CANopen主站實(shí)現(xiàn)DS402伺服控制實(shí)戰(zhàn)

基于RT-Thread的CanFestival移植:CANopen主站實(shí)現(xiàn)DS402伺服控制實(shí)戰(zhàn) 簡(jiǎn)介本資源是一個(gè)面向嵌入式實(shí)時(shí)系統(tǒng)開發(fā)者的DS402運(yùn)動(dòng)控制協(xié)議實(shí)現(xiàn)方案基于CanFestival開源CANopen協(xié)議棧并適配Real-Time-ThreadRTT操作系統(tǒng)專為伺服驅(qū)動(dòng)器、多軸機(jī)器人及工業(yè)自動(dòng)化設(shè)備的CAN總線運(yùn)動(dòng)控制開發(fā)提供可運(yùn)行參考。資源共54個(gè)文件含26個(gè)頭文件.h定義對(duì)象字典、PDO映射、狀態(tài)機(jī)等、19個(gè)源文件.c涵蓋NMT管理、SDO/PDO通信、定時(shí)器與CAN驅(qū)動(dòng)適配、DS402狀態(tài)轉(zhuǎn)換邏輯等核心模塊以及4份Markdown文檔含README與使用說(shuō)明、3個(gè)SCons構(gòu)建腳本和1個(gè)對(duì)象字典.od配置文件整體僅115KB輕量緊湊。已有885人學(xué)習(xí)下載適合具備CAN總線基礎(chǔ)與RTOS開發(fā)經(jīng)驗(yàn)的中級(jí)以上工程師快速掌握DS402協(xié)議在RTT環(huán)境下的集成方法、PDO同步配置、SDO參數(shù)讀寫及運(yùn)動(dòng)模式切換等關(guān)鍵實(shí)踐環(huán)節(jié)。把伺服電機(jī)玩轉(zhuǎn)CanFestival在RT-Thread上實(shí)現(xiàn)CANopen主站的實(shí)戰(zhàn)記錄做工業(yè)運(yùn)動(dòng)控制這幾年伺服驅(qū)動(dòng)器的總線控制始終是個(gè)繞不開的話題。脈沖方向控制簡(jiǎn)單但擴(kuò)展性太差一兩軸還能應(yīng)付設(shè)備一上到六個(gè)軸八個(gè)軸線束、干擾、調(diào)試時(shí)間全都失控。CANopen總線在性能和成本之間算是很平衡的方案但問(wèn)題在于——不管是移植協(xié)議棧還是調(diào)試主站市面上的資料和工具都支離破碎。我這次用RT-Thread跑CanFestival協(xié)議棧配合DS402設(shè)備協(xié)議做了一套CANopen主站從選型到把電機(jī)真正轉(zhuǎn)起來(lái)踩了不少坑也沉淀了不少經(jīng)驗(yàn)。這篇文章就完整記錄下來(lái)給打算自己搭建CANopen主站的朋友做個(gè)參考。先說(shuō)結(jié)論這套方案比我之前用商用CANopen主站工具的情況可控性好很多成本基本為零協(xié)議棧開源環(huán)境是STM32代碼量不算大但要踩明白的坑真不少。整篇文章我分成五個(gè)部分從選型理由、協(xié)議棧移植、主站邏輯、實(shí)際踩坑到可靠性增強(qiáng)逐步展開適合兩種人看一是準(zhǔn)備把CanFestival移植到RT-Thread或裸機(jī)上的嵌入式工程師二是想搞懂CANopen主站到底怎么控制DS402伺服驅(qū)動(dòng)器的開發(fā)者。1. 為什么自己搭主站從脈沖控制到CANopen總線這一步非走不可1.1 設(shè)備升級(jí)過(guò)程中的真實(shí)痛點(diǎn)我手頭這個(gè)項(xiàng)目早期用的是脈沖方向方式控制伺服。六臺(tái)伺服電機(jī)驅(qū)動(dòng)器集中在電氣柜里每臺(tái)電機(jī)要拉脈沖、方向、使能、報(bào)警、復(fù)位這些信號(hào)線再加上編碼器反饋線一捆一捆的屏蔽線布線就是一場(chǎng)災(zāi)難。電氣柜施工周期長(zhǎng)現(xiàn)場(chǎng)總線端子經(jīng)常松動(dòng)排查故障全靠拿萬(wàn)用表一根一根量。真正讓我下決心換CANopen的是一次現(xiàn)場(chǎng)故障伺服報(bào)警反饋線虛接設(shè)備突然急停操作員一臉懵PLC只看到一個(gè)伺服故障的模糊信號(hào)根本定位不到是哪個(gè)軸什么原因。換到CANopen之后每個(gè)節(jié)點(diǎn)的故障碼、驅(qū)動(dòng)器溫度和母線電壓都能通過(guò)SDO讀取遠(yuǎn)程診斷能力完全不一樣。CANopen的另一個(gè)優(yōu)勢(shì)是多軸擴(kuò)展和總線拓?fù)涞撵`活性。脈沖控制的控制器要擴(kuò)展軸數(shù)基本等于換主控CANopen只要在總線上掛節(jié)點(diǎn)主站側(cè)加配置就行。1.2 協(xié)議棧選型為什么是CanFestival而不是CANopenNode在CanFestival和CANopenNode之間糾結(jié)了一段時(shí)間。CANopenNode社區(qū)活躍度確實(shí)高有些新特性支持更好但對(duì)我來(lái)說(shuō)有幾個(gè)關(guān)鍵限制首先是RT-Thread生態(tài)的適配問(wèn)題CANopenNode的硬件抽象層比較分散對(duì)接RT-Thread的設(shè)備框架需要寫不少膠水代碼其次是對(duì)象字典編輯器的體驗(yàn)CANopenNode的編輯器雖然能用但生成代碼的結(jié)構(gòu)和嵌入式的集成方式總感覺(jué)不夠直接。CanFestival吸引我的地方在于它的結(jié)構(gòu)非?!扒度胧健薄麄€(gè)協(xié)議棧就是一組C文件加一個(gè)對(duì)象字典編譯進(jìn)RT-Thread工程后跑在裸線程里沒(méi)有復(fù)雜的動(dòng)態(tài)內(nèi)存分配依賴。它的對(duì)象字典編輯器ObjDictEdit可以生成完全靜態(tài)的字典數(shù)組查表效率高RAM占用可預(yù)測(cè)。另外CanFestival對(duì)DS401、DS402伺服驅(qū)動(dòng)設(shè)備規(guī)范也就是CIA 402的支持比較完整我需要的SDO、PDO、心跳、節(jié)點(diǎn)守護(hù)、同步幀這些機(jī)制都原生具備。1.3 整體架構(gòu)RT-Thread端到端的CANopen系統(tǒng)分層這套系統(tǒng)的結(jié)構(gòu)分四層每一層的職責(zé)邊界我盡量劃清楚應(yīng)用層運(yùn)動(dòng)控制邏輯比如點(diǎn)位運(yùn)動(dòng)、速度曲線、狀態(tài)機(jī)調(diào)度協(xié)議棧層CanFestival核心EMCY、SDO、PDO、NMT、心跳、時(shí)間戳接口層RT-Thread的CAN設(shè)備驅(qū)動(dòng)、定時(shí)器回調(diào)、串口調(diào)試日志硬件層STM32芯片、CAN收發(fā)器、伺服驅(qū)動(dòng)器設(shè)備側(cè)的伺服驅(qū)動(dòng)器我測(cè)試用的是臺(tái)達(dá)和松下各一臺(tái)作為CANopen從站實(shí)現(xiàn)標(biāo)準(zhǔn)DS402對(duì)象字典。主站側(cè)的CanFestival用_nmtMaster模式工作管理整個(gè)總線的啟停和節(jié)點(diǎn)監(jiān)控。------------------------------------------ | 應(yīng)用層運(yùn)動(dòng)控制邏輯 | | 點(diǎn)位 / 速度 / 力矩 指令生成 | ------------------------------------------ | CanFestival 協(xié)議棧核心 | | NMT | SDO | PDO | EMCY | Heartbeat | | 對(duì)象字典靜態(tài)生成的OD | ------------------------------------------ | RT-Thread 設(shè)備框架 | | CAN設(shè)備驅(qū)動(dòng) | 定時(shí)器 | 線程調(diào)度 | ------------------------------------------ | STM32 CAN PHY | ------------------------------------------這個(gè)架構(gòu)的優(yōu)點(diǎn)是把CanFestival當(dāng)成一個(gè)靜態(tài)庫(kù)來(lái)用RT-Thread提供底層調(diào)度和通信能力。我后續(xù)加入的任何功能模塊比如Modbus TCP轉(zhuǎn)CANopen網(wǎng)關(guān)都是按這個(gè)分層來(lái)擴(kuò)展不會(huì)破壞協(xié)議棧的穩(wěn)定性。2. CanFestival在RT-Thread上的移植實(shí)操文件級(jí)集成與關(guān)鍵接口改造2.1 源碼獲取與工程目錄組織CanFestival的官方源碼可以從SourceForge倉(cāng)庫(kù)克隆或者直接從GitHub上的鏡像下載。我的建議是不要直接拖進(jìn)RT-Thread工程就開始編譯先把協(xié)議棧獨(dú)立成一個(gè)子目錄后續(xù)升級(jí)和排查都方便。目錄結(jié)構(gòu)大概長(zhǎng)這樣app/ ├── canfestival/ │ ├── src/ # 協(xié)議棧核心源碼 │ │ ├── can_dcf.c # CAN接口底層需適配 │ │ ├── timers_dcf.c # 定時(shí)器實(shí)現(xiàn)需適配 │ │ ├── lss.c │ │ ├── nmtMaster.c │ │ ├── sdo.c │ │ ├── pdo.c │ │ └── ... │ ├── include/ # 頭文件 │ ├── objdict/ # 生成的對(duì)象字典 │ │ ├── ObjDict.c │ │ ├── ObjDict.h │ │ └── ObjDict_utils.c │ └── drivers/ # 與RT-Thread適配的驅(qū)動(dòng) │ ├── can_rtthread.c │ └── timer_rtthread.c ├── main.c └── SConscript # RT-Thread構(gòu)建腳本移植的重點(diǎn)就是兩個(gè)文件can_dcf.c和timers_dcf.c。2.2 定時(shí)器對(duì)接協(xié)議棧的時(shí)基全依賴這里CanFestival的定時(shí)器機(jī)制比較特殊它內(nèi)部維護(hù)了一個(gè)軟件定時(shí)器鏈表每次調(diào)用TimerIRQ是1ms時(shí)基然后協(xié)議棧自己去處理和比較超時(shí)時(shí)間。RT-Thread里最簡(jiǎn)單的適配方式是用一個(gè)1ms周期的軟件定時(shí)器在回調(diào)里調(diào)用TimerIRQ()。// timer_rtthread.c #include rtthread.h #include timers_dcf.h static rt_timer_t canopen_timer RT_NULL; static void timer_irq_callback(void *parameter) { TimerIRQ(); } void canopen_timer_init(void) { canopen_timer rt_timer_create(canopen_timer, timer_irq_callback, RT_NULL, rt_tick_from_millisecond(1), RT_TIMER_FLAG_PERIODIC | RT_TIMER_FLAG_SOFT_TIMER); if (canopen_timer ! RT_NULL) { rt_timer_start(canopen_timer); } }提示不要用硬件定時(shí)器中斷里的回調(diào)直接實(shí)現(xiàn)TimerIRQ()CanFestival的處理函數(shù)中有一些臨界區(qū)操作如果優(yōu)先級(jí)設(shè)置不當(dāng)很容易破壞協(xié)議棧內(nèi)部的鏈表結(jié)構(gòu)。用RT-Thread的軟件定時(shí)器配合一個(gè)專門的協(xié)議棧線程雖然響應(yīng)有小幅延遲1ms級(jí)別完全可以接受但安全性高很多。還有幾個(gè)關(guān)鍵的定時(shí)指針要提前初始化好void timer_init(void) { TimerIRQ timer_irq_callback; // 這種寫法是在CanFestival內(nèi)部注冊(cè)回調(diào) // 實(shí)際上更常見(jiàn)的是直接讓timer_irq_callback調(diào)用TimerIRQ() }不同版本CanFestival在這塊寫法有些差異我用的3.0版本里initTimer函數(shù)需要把定時(shí)器句柄存到全局變量里。RT-Thread里別忘記使能軟件定時(shí)器宏RT_USING_TIMER_SOFT。2.3 CAN接口對(duì)接從rt_device到canDispatch的橋梁CAN接口的適配是整個(gè)移植里最直接的一層。CanFestival通過(guò)一個(gè)can_port_t類型的口調(diào)用底層的CAN發(fā)送函數(shù)名字固定為canSend不同版本可能叫canSend_或canSendMessage。我維護(hù)了一個(gè)環(huán)形緩沖區(qū)來(lái)緩沖發(fā)送報(bào)文避免在中斷里直接調(diào)用協(xié)議棧的函數(shù)。先看RT-Thread這邊把CAN設(shè)備初始化好// can_rtthread.c #include rtdevice.h #include rtthread.h #include can_dcf.h #define CAN_DEV_NAME can1 static rt_device_t can_dev RT_NULL; static rt_sem_t can_rx_sem RT_NULL; static struct rt_can_msg rx_msg; void can_init(void) { rt_err_t res; struct rt_can_filter_config filter_cfg; can_dev rt_device_find(CAN_DEV_NAME); if (can_dev RT_NULL) { rt_kprintf(can device not found!\n); return; } res rt_device_open(can_dev, RT_DEVICE_FLAG_INT_RX | RT_DEVICE_FLAG_INT_TX); if (res ! RT_EOK) { rt_kprintf(open can device failed!\n); return; } // 設(shè)置接收過(guò)濾器CANopen使用11位標(biāo)準(zhǔn)幀過(guò)濾所有ID struct rt_can_filter_item items[1] { { .id 0x000, .mask 0x000, // 接收所有報(bào)文 .mode RT_CAN_FILTER_MODE_MASK, .ind 0, } }; filter_cfg.items items; filter_cfg.count 1; filter_cfg.activated 1; rt_device_control(can_dev, RT_CAN_CMD_SET_FILTER, filter_cfg); // 創(chuàng)建接收信號(hào)量 can_rx_sem rt_sem_create(can_rx, 0, RT_IPC_FLAG_FIFO); // 設(shè)置接收回調(diào) rt_device_set_rx_indicate(can_dev, can_rx_indicate); }然后是CanFestival協(xié)議的發(fā)送和接收接入// CanFestival底層調(diào)用這個(gè)函數(shù)發(fā)送報(bào)文 UNS8 canSend(Message *m) { struct rt_can_msg tx_msg; tx_msg.id m-cob_id; tx_msg.hdr 0; tx_msg.len m-len; tx_msg.type RT_CAN_STDID; // COB-ID是11位標(biāo)準(zhǔn)ID memcpy(tx_msg.data, m-data, m-len); // 在這里用互斥鎖或直接發(fā)送看具體RT-Thread版本API rt_device_write(can_dev, 0, tx_msg, 1); return 0; } // CAN接收中斷回調(diào)信號(hào)量喚醒線程 void can_rx_indicate(rt_device_t dev, rt_size_t size) { rt_sem_release(can_rx_sem); } // 專用的接收線程 void can_rx_thread_entry(void *param) { struct rt_can_msg rx_msg; Message canopen_msg; while (1) { rt_sem_take(can_rx_sem, RT_WAITING_FOREVER); while (rt_device_read(can_dev, 0, rx_msg, 1) 1) { canopen_msg.cob_id rx_msg.id; canopen_msg.len rx_msg.len; canopen_msg.rtr (rx_msg.type RT_CAN_RTR) ? 1 : 0; memcpy(canopen_msg.data, rx_msg.data, rx_msg.len); // 送入CanFestival協(xié)議棧處理 canDispatch(canopen_OD, canopen_msg); } } }這里有個(gè)容易忽略的細(xì)節(jié)CanFestival的Message數(shù)據(jù)結(jié)構(gòu)和RT-Thread的rt_can_msg在字節(jié)序和位域定義上不完全一致memcpy前最好先轉(zhuǎn)成CanFestival的Message結(jié)構(gòu)體而不是直接把rt_can_msg指針強(qiáng)制轉(zhuǎn)成Message指針?lè)駝t在CAN ID解析那一步很容易出現(xiàn)數(shù)據(jù)錯(cuò)位。2.4 對(duì)象字典生成與DS402從站配置文件的加載對(duì)象字典是CanFestival最核心的靜態(tài)數(shù)據(jù)。我先用ObjDictEdit工具定義好主站需要的所有索引比如0x1000: 設(shè)備類型默認(rèn)值按標(biāo)準(zhǔn)設(shè)0x1005: COB-ID同步幀0x100C: 心跳時(shí)間0x1800-0x18FF: 發(fā)送PDO參數(shù)0x1400-0x14FF: 接收PDO參數(shù)對(duì)于DS402從站控制主站側(cè)的對(duì)象字典里不需要都定義出來(lái)但必須為各個(gè)從站保留地址空間和相關(guān)索引因?yàn)镃anFestival的SDO客戶端功能需要在OD里配置通信參數(shù)。最簡(jiǎn)單的方式是主站OD定義成一個(gè)完備的DSP402類型包含控制字、狀態(tài)字、模式、目標(biāo)位置等索引。當(dāng)然從站側(cè)的DS402對(duì)象字典一般在驅(qū)動(dòng)器的調(diào)試軟件里配置比如臺(tái)達(dá)的ASDA-Soft或松下的PANATERM主站側(cè)直接通過(guò)SDO讀寫即可。對(duì)象字典生成后會(huì)在工程里形成三個(gè)文件ObjDict.c、ObjDict.h和ObjDict_utils.c編譯進(jìn)工程即可。需要特別注意OBJDICT的默認(rèn)值必須和物理總線上的節(jié)點(diǎn)配置一致否則上電后SDO讀回來(lái)的數(shù)據(jù)和OD不一致排查起來(lái)非常繞。3. DS402主站核心邏輯狀態(tài)機(jī)、SDO與PDO的高效配合3.1 DS402設(shè)備狀態(tài)機(jī)與主站聯(lián)動(dòng)DS402定義了一套標(biāo)準(zhǔn)的驅(qū)動(dòng)器狀態(tài)機(jī)這是控制所有CIA 402設(shè)備的通用步驟。主站控制伺服本質(zhì)就是控制狀態(tài)機(jī)的跳轉(zhuǎn)。狀態(tài)圖如下用文字描述狀態(tài)轉(zhuǎn)移關(guān)系Fault - Fault Reset - Switch On Disabled - Ready To Switch On - Switched On - Operation Enable主站通過(guò)寫0x6040控制字索引來(lái)觸發(fā)狀態(tài)跳轉(zhuǎn)。常用的控制字值目標(biāo)狀態(tài)控制字值(hex)說(shuō)明故障復(fù)位0x80清除故障進(jìn)入Switch On Disabled上電準(zhǔn)備0x06Switch On Disabled - Ready To Switch On使能0x07Ready - Switched On操作允許0x0FSwitched On - Operation Enable禁用操作0x07或0x00退回Switched On或Ready一個(gè)測(cè)試用的使能序列函數(shù)長(zhǎng)這樣void ds402_enable_servo(UNS16 node_id) { // 清除故障 sdo_write_u16(node_id, 0x6040, 0x00, 0x80); rt_thread_mdelay(100); // 讀取狀態(tài)字確認(rèn)進(jìn)入Switch On Disabled // ... // 上電準(zhǔn)備 sdo_write_u16(node_id, 0x6040, 0x00, 0x06); rt_thread_mdelay(50); // 使能 sdo_write_u16(node_id, 0x6040, 0x00, 0x07); rt_thread_mdelay(50); // 操作允許 sdo_write_u16(node_id, 0x6040, 0x00, 0x0F); rt_thread_mdelay(50); }狀態(tài)機(jī)跳轉(zhuǎn)的判斷依據(jù)是0x6041索引的狀態(tài)字。這里有個(gè)細(xì)節(jié)狀態(tài)字的第5位quick stop、第6位switch on disabled和第7位warning這些狀態(tài)位組合起來(lái)才能準(zhǔn)確判斷當(dāng)前處于哪個(gè)狀態(tài)不能只看0-3位的值。我在調(diào)試時(shí)用了一個(gè)簡(jiǎn)易的狀態(tài)映射表把所有有效狀態(tài)組合映射成文字打印到串口排查速度快很多。3.2 SDO機(jī)制讀寫參數(shù)的可靠通道SDO是CANopen里用起來(lái)最直接但最容易被“想當(dāng)然”的機(jī)制。CanFestival主站的SDO寫函數(shù)使用sdo_write_u16實(shí)際是sdo_write_*系列底層走的是確認(rèn)型SDO協(xié)議需要等待從站返回確認(rèn)報(bào)文所以調(diào)用過(guò)程是阻塞的。我在主站側(cè)封裝了一個(gè)帶超時(shí)的SDO訪問(wèn)接口#define SDO_TIMEOUT_MS 500 rt_err_t sdo_write_u16(UNS16 node_id, UNS16 index, UNS8 subindex, UNS16 value) { UNS8 data[2]; data[0] value 0xFF; data[1] (value 8) 0xFF; // 調(diào)用CanFestival的SDO寫函數(shù) signed char res sdo_write(canopen_OD, node_id, index, subindex, data, 2, SDO_TIMEOUT_MS); if (res ! 0) { rt_kprintf(SDO write failed: node%d idx0x%X sub0x%X res%d\n, node_id, index, subindex, res); return -RT_ERROR; } return RT_EOK; }這里CanFestival的sdo_write函數(shù)本身會(huì)掛起等待所以必須在獨(dú)立線程里調(diào)用不能在CAN接收中斷或高優(yōu)先級(jí)任務(wù)里直接執(zhí)行。我專門開了一個(gè)SDO線程優(yōu)先級(jí)設(shè)為中等比如20防止阻塞影響主循環(huán)的周期任務(wù)。SDO讀比寫麻煩在返回?cái)?shù)據(jù)的數(shù)量是變長(zhǎng)的需要先發(fā)起讀請(qǐng)求再等響應(yīng)。CanFestival里sdo_read需要預(yù)先分配緩沖區(qū)如果緩沖區(qū)不夠大會(huì)返回錯(cuò)誤碼。我建議讀回的數(shù)據(jù)先打印成十六進(jìn)制再解析避免大小端理解錯(cuò)誤。3.3 PDO配置與運(yùn)動(dòng)控制報(bào)文設(shè)計(jì)PDO運(yùn)用于周期性實(shí)時(shí)數(shù)據(jù)的傳輸。DS402的運(yùn)動(dòng)控制中最常用的同步PDO是這樣設(shè)計(jì)的RPDO1主站到驅(qū)動(dòng)器控制字0x6040 目標(biāo)位置0x607A 或 目標(biāo)速度0x60FF 模式0x6060TPDO1驅(qū)動(dòng)器到主站狀態(tài)字0x6041 實(shí)際位置0x6064 實(shí)際速度0x606C主站側(cè)配置PDO映射和通信周期主要用SDO去寫幾個(gè)關(guān)鍵索引// 配置從站的RPDO1通信參數(shù)0x1400 sdo_write_u32(1, 0x1400, 1, 0x00000200); // COB-ID0x200為RPDO1標(biāo)準(zhǔn)標(biāo)識(shí) sdo_write_u8(1, 0x1400, 2, 0x01); // 傳輸類型0x01表示同步周期1 // 配置PDO映射把控制字和目標(biāo)速度映射進(jìn)RPDO10x1600 sdo_write_u8(1, 0x1600, 0, 0); // 先清零映射數(shù)量 sdo_write_u32(1, 0x1600, 1, 0x60400010); // 控制字 16bit sdo_write_u32(1, 0x1600, 2, 0x60FF0020); // 目標(biāo)速度 32bit sdo_write_u8(1, 0x1600, 0, 2); // 映射數(shù)量為2寫映射項(xiàng)之前必須先把0x1600的subindex 0清零否則部分驅(qū)動(dòng)器會(huì)拒絕修改映射。這個(gè)順序問(wèn)題我一開始沒(méi)注意松下驅(qū)動(dòng)器直接返回SDO網(wǎng)關(guān)錯(cuò)誤排查半天才找到。PDO數(shù)據(jù)按照映射順序緊湊排列控制字2字節(jié)為目標(biāo)速度4字節(jié)總長(zhǎng)6字節(jié)發(fā)送時(shí)CANframe長(zhǎng)度設(shè)成6即可。速度值默認(rèn)是32位有符號(hào)整數(shù)單位取決于驅(qū)動(dòng)器設(shè)定常用rpm或脈沖/s。同步幀的周期也是一個(gè)需要協(xié)調(diào)的參數(shù)。DS402模式下驅(qū)動(dòng)器內(nèi)部的位置控制周期通常設(shè)為1ms或2ms主站發(fā)出SYNC幀0x80后所有配置為同步的PDO報(bào)文才被觸發(fā)執(zhí)行。假如同步周期和驅(qū)動(dòng)器控制周期不匹配實(shí)際運(yùn)動(dòng)會(huì)明顯抖動(dòng)。我這邊用的策略是主站用一個(gè)2ms的定時(shí)器發(fā)送SYNC幀同時(shí)在RPDO的傳輸類型里配置為2每個(gè)同步周期觸發(fā)一次這樣控制循環(huán)和驅(qū)動(dòng)器內(nèi)部循環(huán)天然對(duì)齊。4. 從“節(jié)點(diǎn)發(fā)現(xiàn)不了”到“電機(jī)轉(zhuǎn)起來(lái)”完整踩坑排查鏈路4.1 現(xiàn)象一總線上一個(gè)節(jié)點(diǎn)都發(fā)現(xiàn)不了排查過(guò)程項(xiàng)目剛移植完CanFestival燒錄之后執(zhí)行NMT搜索總線上一片寂靜。我先是拿邏輯分析儀抓了CAN_H和CAN_L的波形發(fā)現(xiàn)確實(shí)有報(bào)文發(fā)出來(lái)但節(jié)點(diǎn)一個(gè)回應(yīng)都沒(méi)有。接著用同樣的物理鏈路換了一個(gè)多合一的CANopen調(diào)試工具去探測(cè)節(jié)點(diǎn)全部正常響應(yīng)——說(shuō)明問(wèn)題不在驅(qū)動(dòng)物理鏈路而是主站報(bào)文的數(shù)據(jù)結(jié)構(gòu)或ID映射出了問(wèn)題。拿CANalyzer直接查看主站發(fā)出來(lái)的報(bào)文發(fā)現(xiàn)問(wèn)題出在COB-ID的賦值上。CanFestival內(nèi)部用Message結(jié)構(gòu)體的cob_id成員存儲(chǔ)COB-ID但在底層發(fā)送時(shí)需要區(qū)分標(biāo)準(zhǔn)幀11位ID和擴(kuò)展幀29位ID。我在CAN發(fā)送函數(shù)里直接把cob_id賦給了rt_can_msg的id字段可RTT的CAN驅(qū)動(dòng)默認(rèn)是按擴(kuò)展幀還是標(biāo)準(zhǔn)幀處理取決于type變量。沒(méi)有給type賦為RT_CAN_STDID時(shí)驅(qū)動(dòng)按29位ID解析設(shè)備側(cè)當(dāng)然不認(rèn)。修復(fù)方式是發(fā)送前先強(qiáng)制指定幀類型同時(shí)把cob_id轉(zhuǎn)成標(biāo)準(zhǔn)ID格式tx_msg.type RT_CAN_STDID; tx_msg.id m-cob_id 0x7FF; // 確保只留低11位這個(gè)坑屬于典型的協(xié)議棧與驅(qū)動(dòng)之間的“上下文丟失”問(wèn)題。CanFestival在協(xié)議棧內(nèi)部已經(jīng)把標(biāo)準(zhǔn)幀和擴(kuò)展幀區(qū)分得非常清楚但到了驅(qū)動(dòng)層必須重新設(shè)置一遍。根源分析更深層的問(wèn)題是我在適配層拷貝報(bào)文結(jié)構(gòu)時(shí)沒(méi)有完整保存所有標(biāo)識(shí)字段。Message結(jié)構(gòu)體在不同版本CanFestival里有些成員是位域bitfield有些是普通UNS32。如果驅(qū)動(dòng)層對(duì)位域結(jié)構(gòu)理解不對(duì)打包出來(lái)的字節(jié)序就會(huì)錯(cuò)位。建議移植時(shí)直接從官方例程復(fù)制can_dcf.c去改不要自己憑感覺(jué)寫報(bào)文轉(zhuǎn)換函數(shù)。4.2 現(xiàn)象二SDO讀寫超時(shí)但PDO收發(fā)正常排查過(guò)程節(jié)點(diǎn)能被發(fā)現(xiàn)了心跳報(bào)文也正常但SDO讀驅(qū)動(dòng)器軟件版本號(hào)時(shí)一直超時(shí)。我一開始懷疑是SDO線程優(yōu)先級(jí)太低被PDO報(bào)文擠掉了于是把SDO線程優(yōu)先級(jí)提到了最高結(jié)果反而更嚴(yán)重——SDO超時(shí)頻繁電機(jī)偶爾一頓一頓。冷靜下來(lái)確認(rèn)了總線上實(shí)際跑的是什么。抓包發(fā)現(xiàn)SDO請(qǐng)求已經(jīng)發(fā)到總線上但響應(yīng)報(bào)文的COB-ID和我預(yù)期不一致導(dǎo)致協(xié)議棧在SDO層等待對(duì)應(yīng)ID的報(bào)文時(shí)一直收不到。查了驅(qū)動(dòng)器的對(duì)象字典發(fā)現(xiàn)SDO服務(wù)端配置里發(fā)送響應(yīng)用的節(jié)點(diǎn)ID被配置成了另一個(gè)地址。簡(jiǎn)單說(shuō)驅(qū)動(dòng)器的SDO服務(wù)端COB-ID是由“0x580 節(jié)點(diǎn)ID”組成的如果驅(qū)動(dòng)器側(cè)手動(dòng)改了節(jié)點(diǎn)相關(guān)的PDO/ SDO標(biāo)識(shí)主站按默認(rèn)規(guī)則算出來(lái)的ID就全對(duì)不上。解決辦法是在總線上電后先用一個(gè)固定的已知節(jié)點(diǎn)ID出廠默認(rèn)發(fā)起SDO讀獲取當(dāng)前節(jié)點(diǎn)的實(shí)際標(biāo)識(shí)配置然后重新映射主站的通信表。操作建議實(shí)際項(xiàng)目中我建議做個(gè)自動(dòng)掃描流程上電后逐個(gè)節(jié)點(diǎn)ID1到127發(fā)NMT節(jié)點(diǎn)啟動(dòng)命令同時(shí)監(jiān)聽心跳或Boot-up報(bào)文把響應(yīng)節(jié)點(diǎn)記錄下來(lái)。響應(yīng)表里列出來(lái)后再去做SDO配置。這個(gè)掃描流程也便于后續(xù)設(shè)備批量下載地址。4.3 現(xiàn)象三電機(jī)能轉(zhuǎn)但速度抖動(dòng)明顯排查過(guò)程SDO能讀PDO能跑控制字寫進(jìn)去電機(jī)也能轉(zhuǎn)了。但速度在低轉(zhuǎn)速比如300rpm下抖動(dòng)明顯示波器看編碼器反饋波形有周期性的毛刺。這是非常典型的同步問(wèn)題。我最初把SYNC幀周期設(shè)在5ms而驅(qū)動(dòng)器內(nèi)部的速度環(huán)周期是250us兩者差距太大每個(gè)同步周期之間的時(shí)間差導(dǎo)致速度積分漂移。把SYNC周期改成1ms然后把PDO的傳輸類型改成“同步周期1”抖動(dòng)立刻緩解了很多。但還有一點(diǎn)低頻波動(dòng)最后發(fā)現(xiàn)是RT-Thread里發(fā)送SYNC幀的定時(shí)器優(yōu)先級(jí)和SDO處理線程沖突。軟件定時(shí)器回調(diào)時(shí)不時(shí)晚幾百微秒導(dǎo)致SYNC的實(shí)際間隔時(shí)間不均勻。解決方案是不要用軟件定時(shí)器發(fā)SYNC改用一個(gè)獨(dú)立的硬件定時(shí)器PWM輸出模式或者把SYNC發(fā)送邏輯放到高優(yōu)先級(jí)中斷里。最穩(wěn)妥的方案是用RT-Thread的rt_timer設(shè)置更精細(xì)的周期或者直接用硬定時(shí)器中斷觸發(fā)rt_sem_release在專用線程里構(gòu)造SYNC幀發(fā)送。實(shí)測(cè)下來(lái)周期抖動(dòng)控制在±50us以內(nèi)就能滿足大多數(shù)伺服的速度平穩(wěn)性要求。排查鏈路總結(jié)這個(gè)環(huán)節(jié)的排查順序很重要先用邏輯分析儀抓總線波形確認(rèn)物理層和CAN控制器收發(fā)正常再看主站發(fā)出去的COB-ID和極幀類型是否匹配設(shè)備端配置然后看SDO事務(wù)數(shù)據(jù)鏈路是不是ID映射或數(shù)據(jù)長(zhǎng)度不一致最后才考慮從站的NMT節(jié)點(diǎn)初始化流程是否完整、心跳超時(shí)設(shè)置是否過(guò)短這套排查順序能幫你在四五個(gè)小時(shí)內(nèi)定位問(wèn)題而不是靠猜。5. 可靠性增強(qiáng)心跳監(jiān)測(cè)、故障恢復(fù)與后續(xù)演進(jìn)5.1 心跳監(jiān)測(cè)讓總線故障透明化CANopen的心跳機(jī)制Heartbeat通過(guò)每個(gè)節(jié)點(diǎn)周期性發(fā)送0x700node_id的報(bào)文向外報(bào)告“我還活著”。主站側(cè)收到任意節(jié)點(diǎn)的心跳報(bào)文后可以根據(jù)預(yù)先配置的心跳超時(shí)時(shí)間來(lái)判斷節(jié)點(diǎn)是否掉線。CanFestival里心跳超時(shí)事件通過(guò)定時(shí)器管理在OD的0x100C生產(chǎn)者心跳時(shí)間和0x1010/0x1011消費(fèi)心跳中配置。主站側(cè)要定期把所有節(jié)點(diǎn)的心跳超時(shí)清零并重新啟動(dòng)定時(shí)器。我采用了一個(gè)比協(xié)議棧自帶機(jī)制更直接的方式用RT-Thread的軟件定時(shí)器定期查詢?nèi)值男奶鵂顟B(tài)變量。每個(gè)節(jié)點(diǎn)在上電后配置完心跳周期后向0x1016和0x1017寫入期望值然后在協(xié)議棧回調(diào)中遞增對(duì)應(yīng)的狀態(tài)計(jì)數(shù)器主線程每秒檢查計(jì)數(shù)器增量是否正常如果有節(jié)點(diǎn)超時(shí)未更新就觸發(fā)NMT復(fù)位和報(bào)警輸出。void canopen_heartbeat_check(void) { for (int i 1; i NODE_COUNT; i) { if (rt_tick_get() - node_heartbeat_tick[i] rt_tick_from_millisecond(1000)) { rt_kprintf(Node %d heartbeat lost!\n, i); // 觸發(fā)報(bào)警嘗試復(fù)位節(jié)點(diǎn) nmt_command(canopen_OD, NMT_RESET_NODE, i); } } }5.2 掉線自動(dòng)復(fù)位與故障恢復(fù)系統(tǒng)伺服驅(qū)動(dòng)器一旦觸發(fā)報(bào)警并停機(jī)主站需要按照DS402的狀態(tài)機(jī)要求執(zhí)行“故障復(fù)位”操作而不是直接發(fā)使能。這部分邏輯往往被初學(xué)者忽略故障復(fù)位是寫入控制字的0x80帶上升沿必須在寫入后保持一段時(shí)間的0x00才能正確清除故障狀態(tài)。很多人寫0x80就直接跳回0x06結(jié)果故障沒(méi)清除重新使能失敗。我封裝了這么一個(gè)函數(shù)int ds402_fault_reset(UNS16 node_id) { sdo_write_u16(node_id, 0x6040, 0x00, 0x80); rt_thread_mdelay(200); sdo_write_u16(node_id, 0x6040, 0x00, 0x00); rt_thread_mdelay(100); // 輪詢狀態(tài)字直到離開Fault狀態(tài) for (int i 0; i 10; i) { UNS16 status sdo_read_u16(node_id, 0x6041, 0x00); if ((status 0x10) 0) // bit40表示不在Fault狀態(tài) { return 0; } rt_thread_mdelay(200); } return -1; }主站側(cè)還要有一個(gè)總線級(jí)錯(cuò)誤處理機(jī)制。比如某一個(gè)從站掉線超過(guò)3秒系統(tǒng)自動(dòng)把另外幾個(gè)已使能的從站拉回到Ready狀態(tài)防止運(yùn)動(dòng)失控。這個(gè)互鎖邏輯我在RT-Thread的全局任務(wù)里實(shí)現(xiàn)優(yōu)先級(jí)低于PDO周期任務(wù)保證正常運(yùn)動(dòng)不受影響。5.3 后續(xù)演進(jìn)多主站冗余、CiA 402其他模式與協(xié)議棧升級(jí)這套主站框架跑穩(wěn)之后我計(jì)劃做幾件事接入CiA 402的Cyclic Synchronous PositionCSP模式。CSP模式下每個(gè)同步周期主站都要把目標(biāo)位置寫入RPDO驅(qū)動(dòng)器在內(nèi)部位置環(huán)做插值。這個(gè)模式對(duì)Sync幀周期抖動(dòng)的要求極高通常小于50us我打算把SYNC幀遷移到STM32的硬件定時(shí)器觸發(fā)上保證周期穩(wěn)定性。加了PROFINET轉(zhuǎn)CANopen網(wǎng)關(guān)。通過(guò)在應(yīng)用層增加一個(gè)上位機(jī)透?jìng)鹘涌诎裇DO/PDO數(shù)據(jù)映射為Modbus寄存器方便觸摸屏或PC組態(tài)軟件直接訪問(wèn)驅(qū)動(dòng)器參數(shù)。重新梳理CanFestival的NMT狀態(tài)管理。現(xiàn)版本協(xié)議棧的主站NMT管理偏粗糙遇到多節(jié)點(diǎn)同時(shí)掉線時(shí)的恢復(fù)策略需要自己補(bǔ)。我計(jì)劃在應(yīng)用層實(shí)現(xiàn)兩個(gè)狀態(tài)表一個(gè)表示實(shí)際總線狀態(tài)一個(gè)表示應(yīng)用控制狀態(tài)兩者之間做狀態(tài)機(jī)轉(zhuǎn)換這樣能實(shí)現(xiàn)更精細(xì)的故障恢復(fù)流程。寫在最后CanFestival加RT-Thread這套組合做小型的CANopen主站絕對(duì)夠用。它的門檻主要在兩個(gè)地方一是協(xié)議棧的適配文件需要耐心調(diào)試特別是定時(shí)器和CAN接口二是DS402狀態(tài)機(jī)的理解不能拿普通Modbus那套“寫個(gè)寄存器就轉(zhuǎn)”的思路來(lái)對(duì)待。但一旦把這兩塊啃下來(lái)后面控制多少個(gè)軸都只是配置的問(wèn)題不會(huì)再像脈沖控制那樣被線纜拖累。如果讓我重新選一次我還是會(huì)走自研主站這條路。用現(xiàn)成的商業(yè)主站工具確實(shí)省事但黑盒調(diào)試在現(xiàn)場(chǎng)遇到問(wèn)題的時(shí)候那種無(wú)從下手的感覺(jué)才最要命。自己寫的協(xié)議棧適配每一個(gè)字節(jié)都是自己排過(guò)的出了問(wèn)題知道去哪里看這才是長(zhǎng)期項(xiàng)目最需要的底氣。本文還有配套的精品資源點(diǎn)擊獲取
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
婷婷色五月在线视频| 可以看的av| 91窝窝| 日韩狠狠色婷婷| 久久久久人妻精品| 啪啪激情网站| 超91热| 五月激情天天干| 婷婷色色亚洲| 五月天伊人久久久久| 天天综合网91| 思思热视频| 激情婷婷色小说| 91色久| site:picc-up.com| 色色色色色日韩午夜激情| 亭亭五月丁香五月天激情| 婷婷大乡焦噜噜| 婷婷天天色| 操笔无码| 青青日韩| 久久久久人妻| www五月天com| 久热9| 少妇人妻人伦A片| 伊人色综在线| 久久久中文| 亚洲精品无码一区二区| 九九成人| 99小精品| 五月天婷婷激情在线色图| 97人人超| 日日舔夜夜操| 丁香六月AV| 变态 另类 在线| 草综合14| 91超级碰碰| 亚洲字幕AV一区二区三区四区| 天天爽天天摸人妻综合网| 色99日韩| 99色免费观看全部| 9色在线| 无码激情精品色婷婷久久久久| 婷婷激情五月天激情小说| 欧美激情综合色综合啪啪五月| 五月天色婷婷激情综合| 国产4P视频精品五区| 综合网亚洲| 天天干-天天日| www.久久久久久久久久久| 久久久久久综合88| 婷婷五月深爱五月| 激情综合网五月天天| 激情五月天福利| 日本三级大片| 丁香五月电影| 激情综合网五月天天| 九九热青青草| 91九九九九| 五月天婷婷丁香| 五月婷婷伦理| 九九婷婷综合| 亚洲亚洲人成综合网络| 俺去也婷婷| 色爱99| 毛片蕉地一二| 午夜69成人做爰视频| 五月丁香婷婷综合| 极品 少妇 内射| 啪啪夜久久| 欧美性色A片免费免费观看的| 丁香五月成人婷婷| 色五月开心开心五月激情五月| 91丁香五月| 伊人久久丁香五月91| 97操碰视频| 人人干AV| 亚洲国产精品VA在线看黑人| 色欲色香综合网| 可以看的av网站| 亚洲无码影音| 99热青青草| 五月草影视| 《诡秘之主》在线观看| 婷婷综合久久综合| 五月丁香激情综合网| 综合亚洲六月婷婷在线| 91妻人人爽人人看片| 亚洲午夜成人av电影网| 日韩六十路91性交电影| 精品夜夜澡人妻无码AV| 第六色在线| 五月激情久久综合网| 伍月婷丁香婷| 亚洲婷婷久久综合| 婷婷成人五月天一区| 丁香五月婷婷色情综合| 丁香久久五月婷综合| 老妇六区| 成人综合网站| 五月天色色色| 色五月丁香网| 婷婷久久99| 色欲久久久久| 婷婷色成人| 婷婷丁香五另类网站| 五月丁香综合啪啪| 91玖玖| 久久伊人婷| 日本少妇裸体做爰高潮片| 91婷婷搞| 色天堂A| 丁香五月婷婷手机| 成人精品99| 另类图片激情五月天| 色婷婷免费观看| 94干大香蕉| 日韩人妻AV在线| 激情AV| 99久久9| 亚洲综合色网| 久久精品夜色噜噜亚洲a∨| 精品久久66| 九九婷婷五月天影视| 亚洲国产色婷婷| 婷婷综合色| 中文字幕五月久久婷| 婷婷激情五月天激情小说 | 九九热短视频在线观看| 久久人妻系列| www.minyis.com【JT】国内CDN落地页保证转化QQ2101460746 | ...婷婷五月综合不卡,国产在线手机| 丁香婷婷综合影院| www网站在线观看| 色欲五月丁香| 在线超碰免费| 天天色五月婷婷91久久久久久久| 丁香婷婷激情四射五月| 亚洲 成人 电影av在线观看| 婷婷丁香黄色| 色色丁香五月| 丁香五月另类色婷婷麻豆| 99ri精品在线| 色色色婷婷五月天| 97碰在线视频| 涩综合在线 | 亚洲精品婷婷| 五月激情综合网| 国产日韩欧美性爱| 欧美成人AAA片一区国产精品| 天天日综合| 亚洲五月花| 色色操| 婷婷午夜天| 熟女激情五月天| 亚洲激情五月| 日韩中文字幕| 五月天综合色| 99久久97久久欧美综合网| WWW,五月| 玖玖资源站国产| 欧美va精品va老师va| 亚洲婷婷在线播放十月| 另类综合激情| 停停五月天激情网| 99热碰碰| 狠狠色噜噜狠狠狠888| 99在线免费观看| 五月天激情小说| 无码免费人妻A片AAA毛片西瓜| 成人做爰高潮A片免费视频| 97精品人人A片免费看| 中文字幕1区2区。| 婷婷婷五月香蕉| 免费AV在线网址| 亚洲午夜一区二区| 热99国产精品| 久久这里99| 国语精品探花| 激情丁香九九五月综合网| 99在线精品观看99| 三年高清大片免费观看国语| 日韩操啪| 色播五月丁香| 激情综合网激情五月网| 99热亚洲| 激情综合网五月婷婷| 欧美性生交A片免费看| 五月丁香婷婷激情图片| 五月婷婷啪啪啪| 综合在线网| 狠狠操在线视频| 天天色综网| 狼人婷婷久久| 蜜桃人妻无码AV天堂三区| 久久婷婷免费| 色婷婷综合久久久久| 久久亚洲A| 激情黄色小说五月天| 91色情播放| 亚洲色夜| 久久A极片| 国产色网站| 五月天色丁香| 五月天激情网图片| 五月婷免费视频| 91欧美日韩| 久操乱| 超级碰碰碰碰视频| 天天综合插插| 色综合综合色| 久热这里只有精品99re,久热这里只有精品7| 久热99中文字幕| 欧美槡BBBB槡BBB少妇| 九色综合五月天婷五月| 欧美成性色| 婷婷五月六月激情| 丁香激情五月天| 欧美一级a| 欧美三级欧美一级| 九九视频这里有精品| 99视频久久| 久久国产一区二区三区| 久久婷婷五月综合色奶水99啪| 男人天堂亚洲综合| www,色婷婷| 99热99艹在线观看| 九九国产视频| 五月婷婷啪啪| 香蕉久久国产AV一区二区| 亚洲AV无码成人精品区电影网| 亚州精品色情无码A片| 婷婷色网站| 欧美色图天堂网| 久热A片| 久婷| 婷婷五月天成人小说| 亚洲热久久| 五月天婷婷Av| 亚洲久久视频| 粉嫩av蜜桃av蜜臀av| 丁香五月激情图片婷婷 | 色五月婷婷777| 五月婷婷偷拍| 婷婷五月天电影区小说区| 婷婷色五月激情| 丁香婷婷影院| 激情五月天啪啪| 丁香婷婷五月六月久久| 亚洲色五月婷婷| 国产日韩欧美性生活| 天天插天天插| 伊人天堂婷婷| 五月天色官网| 深爱激情五月网| 婷婷五月激情综合啪啪| 色五月六月婷婷| 日本婷婷| 婷婷的久久网站| ji'qi'luan'ren'lun| 国产欧美性成人精品午夜| 国产综合色婷婷精品久久| 婷婷色狠狠| 亚洲综合激情五月久久| 996精品热视频| 五月激情丁香| 久久久国产精品黄毛片| 激情五月开心五月在线视频| 狠狠综合网| 五月丁香毛片| 国产精品人人妻人人爽| 91碰免费视频| 天天摸天天高潮天天爽| 国产精产国品一二三在观看| 婷婷色五月综合丁香| 色综合久久88色综合天天看| 99九九热视频免费| 色婷婷六月丁香综合欲精品| 日韩欧美成人一区二区三区| renrencaoav| 色色色色网| 亚洲综合另类| 一级二级色大片| 天堂美国久久| 色婷五月| .青娱乐天天操B| 丁香婷婷久久| 婷婷导航| 91五月天| AA丁香综合激情| 五月婷久久草| 国产综合婷婷| 欧洲一区二区| 武则天精品久久| 99手机在线精品视频| 色婷婷五月天视频在线| 香蕉色色网| 免费视频这里只有精品| 日本三级第一页| 激情校园 亚洲| 久9视频| 色优久久| 激情六月婷婷| 再綫Av免费視品| 丁香五月AV| 久久婷婷五月天激情新地址| 欧美色五月| 九九99精品视频在线观看| 久久玖玖综合| 激情六月婷婷| 五月婷婷片| 九九热AV| 色五月激情五月开心五月| 五月丁香综合啪啪| 九九99久久| 色综合激情| 综合AV在线| 综合激情在线视频| 九九黄色网| 久久曰曰| 亚洲五月婷婷| 有码人妻久久| 日韩ww| 99这里是精品| 日韩无码乱轮| 黄色片区子| 久月婷婷| 久久婷婷视频| 色情激情五月| 久久综合香蕉国产国产蜜臀AV| 深爱激情婷| 99九九热视频免费| 97久久草草超级碰碰碰| 99久热在线精品| 五月婷婷六月丁香在线| 一个色的综合| 久久久亚洲成人无码A片| 色欲一二三| 午夜丁香六月婷| 婷婷色啪| 色六月天天激情综合网| 国产精品美女久久久久AV超清| 五月天婷婷黄色| 91大屁股在线| 天天爱综合网| 日木狠狠干| 丰满老熟妇BBBBB搡BBB| 99久久玖玖| 丁香五月大香蕉AV| 99热最新| 婷婷六月天激情影院| 狠狠爱丁香婷| 婷婷九月丁香| 五月丁香六月婷婷免费| 婷婷 丁香 久久| 99热新网址| 色婷婷中文| 婷婷五月欧美综合| 色五月天成人在线| 成人综合网站| 丁香婷婷色| 猫咪伊人久久| 五月天婷婷成人| 激情色五月天| 亚洲AV人人操| www..com色爱| 亚洲色综合色网| 女人天堂 AV| 国产做A爰片毛片A片美国| 婷婷亚洲五| 91.www综合| 99亚州综合精品成人网| 五月婷婷丁香| 五月婷婷久久激情| 玖玖热99| 亚洲六月色| 第一区久久网站| 亚洲色综久久五月| 欧美丰满熟妇BBB久久久| 人人看人人摸人人| 亚洲高清在线| 天天日日| 婷婷综合| 婷婷五月视频| 99热最新精品| 九九精品碰| 99热老网站| 国熟女视频| 久久久五月天网站| 国产SUV精品一区二区6| 婷婷色导航| 丁香六月AV| 婷婷综合久久综合| 成人在线99| 99热只有精| 操97| 婷婷五月精品| 色屌丝中文字幕| 五月天婷婷激情春色小说| 精品亚洲国产成AV人片传媒 | 98色花堂98t.R| 日本的α片xxxwww| 69精品人妻不卡视频| 五月婷婷六月丁香综合在线| 亚洲五月色| 操91| 婷婷性爱五月天丁香网| 99自拍视频在线| 婷婷伊人网| 99久久a线观| 91免费啪视频| 五月丁香综合| 六月婷婷八月丁香| 五月丁综合在线观看| 毛片新网地| 欧美情色电影一区二区| 性爱综合网| 99综合激情久久精品久久| www.激情五月天。com| 亚洲视频久久| 国产做爰视频免费播放| 少妇激情五月天| 色五月婷婷中文字幕在线观看 | 亚洲小视频| ss99热| 黄色国久久| 久久人妻情侣| 久久色五月| 一级操逼内射在线视频| 丁香婷婷午夜| 婷婷五月天久草在线| 日本久久99| 99免费在线| 蜜乳国产网站| 亚洲另类婷婷五月丁香在线播放| 韩国中文字幕91| 伊人在线视频| PORNY九色9l自拍视频成人| 99热成人在线观看| 亚洲综合五月天综合| 婷婷五月亚洲综合| 亚洲六月婷婷| 国产精品丝| 久久日婷婷| 免费观看欧美成人AA片爱我多深| 久久精品视频99| 亭亭玉月丁香| 天天做天天爱天天要| 三级成人网站| 99热视| 激情五月丁香五月| 91色综合网| 国产99久9在线| 婷婷99狠| 色色综合网www| 中文字幕日产A片在线看| 丁香五月婷久久| 婷婷丁香激情综合色情| 五月天婷婷AV| 99人妻碰碰碰久久久久视| 丁香五月六月婷婷殴美综合| 亚洲综合色棒| 五月婷在线色视频| 天天舔天天插天天干| 丁香香五月激情免费视频| 99精品久久久久久久婷婷| 大香蕉久久婷婷精品综合| 壅壅儕家a| 综合 激情 婷婷| 久久97久久99久久综合欧美| 久久99久久99精品,久国产,久久精品免费,99久在线,久久久久国产精品免费网站,9 | 色综合激情| 五月婷婷色啪| 久婷婷五月综合欧美| 免费成人中文字幕| 91色欲综合| 91热久88| 美女视频图片久久91| 久久婷婷五月综合色区| 天堂在线观看视频| 亚州男人天堂婷婷五月| 五月丁香婷久久| 玖玖婷婷五月天毛片| 爱操天堂| 久久久潮喷-久久久九九-成人AV| 性爱激情久久| 日本高清不卡免费一区二区三区| 五月天婷婷激情六月久久| 99热人人艹| 丁香婷婷激情网站| 操草草草| 人人妻人人澡人人爽| 九热电影av| 91互操| 色婷另类| 国产精品久久久久久白浆色欲| 黄色五月婷婷| 丁香色五月直播| 热的五码久久精品| 天天插天天草人人玩| 婷婷丁香水多多视频| 五月的婷婷六月丁香| 日韩av大全| 婷婷五月天色综合| 久久99激情丁香婷婷小说网| 婷婷五月在线观看| 激情综合九月| 少妇综合网| 色五月综合| 亚洲亚洲人成综合网络| 五月天婷婷无码| 伊人丁香五月婷婷潮吹| 婷婷五月综合色拍| 婷婷成人网五月天| 熟女激情网| 天天舔天天| 99热99热不卡| 激情综合色婷婷啪啪六月天| 99精品久久| 亚洲精品久久久久久久久久吃药| 大香蕉综合视频在线| 激情五月婷婷色综合| 婷婷伊人五月丁香天堂网| 色五月欧美| 色色操| 婷婷激情综合色五月久久,色婷婷丁香花,丁香婷婷五月情天,久久婷婷五月综合色 | 激情综合网五月婷婷| 青青久在线视频免费观看| 婷婷五月天桃花网| 这里只有精品视频在线| 超碰人人操| 丁香五月婷婷在线观看| 久久婷狠狠色| 夜夜爽天天干| 99热色精品| 9l视频自拍9l九色成人| 色婷婷丁香AV综合| 亚洲视频丁香网va| 激情五月婷婷网在线观看| 婷婷丁香人妻久久在线观看| 激情精品久久| www.伊人天堂偷偷婷婷| 婷婷色五月在线视频| 色五月天堂| 精品亚洲国产成人A片在线鸭王| 综合五月天| 丁香五月婷婷社区| 日亚二欧美| 99热这里在线精品| 丁香婷婷婷五月| 99热综合网| 亚州美女| 啪啪黄页网| 开心久久xxx色| 婷婷五月天日本无码| 青青草原伊人网| 五月天色综合| 五月婷婷综合性爱噜噜| 五月色情婷婷| 人人摸人人摸| 婷婷亚洲综合| 99热官网精品在线| 激情五月深爱五月| 激情六月婷| 午夜天堂啪啪| 人妻在线观看视频| 久久草大香蕉| 亚洲欧美999| 亚洲丁香花色| 中文婷婷狠狠| 狠狠干五月天婷婷网| 这里只有精品在线看| 婷婷色网站| 免费在线观看AV网站| 激情中文在线| 丁香五月激情视频在线| 玖玖综合色| 六月婷婷毛片| 五月婷婷av| 免费播放99性爱视频| 婷婷九月丁香| 日产精品一线二线三线芒果| 婷婷少妇激情| 五月六月激情| 亚洲天天操| 日韩有码一区| 五月丁香美女| 久久视频婷婷| 五月天色软件| 人人玩人人橾| 免费啪啪亚州视频| 9 7总站超级碰免费视频| 99色综合网| 欧美日韩AAAA| 97高清国语自产拍| 99啪啪| 久久人妻久久| 99热99这里有免费的精品| 久草大| 综合久久五月| 丁香五月婷婷成人综合| 91丨九色丨大屁股| 69色婷婷| 狠狠五月天激情| 丁香五月性| 97干在线观看视频| 天天干 夜夜爽| 亚洲精品又粗又大又爽A片| 丁香狠狠色婷婷| 久久久久久丁香五月| 五月天另类激情在线| 91好好热日本在线| 思思国产99| 婷婷啪啪| 天天色天天爽| 五月停亭六月,六月停亭的英语 | 亚洲色婷婷| 五月婷婷影| 婷婷色丁香六月| 性做爰A片免费视频A片直播| 99热这里只有精品国产免费| 久/久精品99看9| 欧美精品A片一区在线观看| 99re在线这里只有精品视频首页| 成 人片 黄 色 大 片| 欧美日韩99| 日韩av在线免费观看| 人操91在线| 激情网开心网| 被男人添B超爽视频| 色噜噜婷婷| 8区视频在线| 97香蕉人人在线观看| 日日做天天操夜夜爽| 五月婷婷综合激情| ay2区| 91精品久久久久久77777| 97日在线视频| 欧美色婷婷| www.九九婷婷| 开心五月天激情网站| 婷婷99视频在线| 热久久66| 嫩草AV久久伊人妇女超级A| 日本女va| 日韩成人免费电影| 五月婷婷色播视频| 夜夜爱网站| 激情综合亚洲| 色婷婷影院| 五月丁香啪啪啪综合网| 精品成人久久久久久久_一二三四视| www久久艹| 激情综合一| www.五月婷| 99色亚洲| 久久综合五月| 五月综合久久| 日本系列_4页_777FP| 国产成人在线精品| 五月丁香av中文| 色色色99| 丁香丁婷五月激情| 99在线精品观看99| 天天综合干| 国产精产国品一二三在观看| 综合六月激情婷婷| www.99操| 色综合天天综合成人网| 另类激情码| 五月天婷婷免费| 9久久久久久久久久久| 人人摸人人操人人爽| 亚洲中文字幕av| 99精品综合| 激情美女五月天| 啪啪啪综合网| 秋霞电影理论| 五月综合激情网| 五月丁香六月婷婷综合| 任你干嘛免费视频播放| 色欧美影院| 九九热re99re6在线精品| 久9久9热久热| 综合五月草| 国产亚洲精品久久久久久牛牛| 女人天堂av| 国产AV影片| 26uuu亚洲精品国产| 成年视频免费观看| 九九99九九99| 久鲁鲁色网| 性生生活大片又黄又| 五月天停停成人网| 丁香六月激情毛片| 亚洲午夜AV| 天天草狠狠擦| 69久久久| 超碰免费大香蕉| 婷婷五月黄色激情在线| 日韩一级一片内射视频4K| 99国产在线| 色停停香蕉视频| 激情综合色| 欧美激情综合色综合色| 99超级碰碰| 色五月婷婷在线| 婷婷色五月天综合网| 中文字幕久久婷九女同| 九九热av| www.人人操人人看人人想人人摸 人人人人操,COM | 性爱先锋AV| av网站不卡在线| 久久99网| 人妻狠狠操| 色逼综合网| 99精品在线| 丁香五月电影| 国产在线网| 婷婷婷婷婷婷婷婷| 丁香五月亚洲激情婷婷射| 日韩黄色中文字幕| www.婷婷| 久热这里只有精品在线观看 | 婷婷色在线视频| 婷婷五月天影院| 丁香五月天成人| 色婷婷大香蕉| 婷婷五月天天| 啪啪操超碰| 天天日夜夜B久久| 日本在线观看aaa 99| 亚洲操人| 色久激情在线| 精品久色| 婷婷五月天大香蕉在线视频观看| 五月丁香婷婷综合网| 五月丁香五月天现场视频| 99乱视频| 极品精品一区二区三区在线| 任你爽精品免费视频6| 久久国产AV| 天天色天天操天天射| 激情五月深爱五月| 1024亚洲| 色播五月丁香| 北条麻妃伊人| 亚洲成人五月天| 丁香婷婷大香蕉| 丁香六月啪啪| 五月天婷婷在线视频| 久久久久亚洲A∨成人乱码电影| 99热欲| www.婷婷五月天.com| 五月婷婷影| 婷婷午夜综合| 国产一级视频a| 六月丁香五月婷婷首页| 91日综合欧美| 另类少妇人与禽zOZZ0性伦| 丁香五月成人网| 婷婷五月天伦理| 97人人搞| 亚洲婷婷久久综合| 综合久| 超碰无码老师| AA丁香综合激情| 色色亚洲| 99热成人在线| 婷婷五月天.com| 五月丁香琪琪| 色吊丝99| 三男玩一女三A片| 亚洲精品电影| 五月丁香六月婷婷国产视频| 丁香六月色情| 超碰99在线观看| 伊人久久大香线蕉AV最新午夜| 99色| 99久久综合| www五月| 天天做综合网色综合| 色播丁香| 2016日日夜夜操| 97超级啪啪在线观看| 91狠狠综合久久| 91九色熟女| 九九亚洲视频| 天天射综合网天天插| 欧美色图45678| 2016日日夜夜操| 99热亚州综合| 激情六月天| 激情五月影院| AV在线大香蕉| 玖玖热视频| 996热re视频精品视频这里| 26uuu欧美日韩| 综合视频久久| 超级碰碰碰碰视频| 色停停影院五月天| 婷婷五月欧美综合| 色婷婷综合网站| 99在线精品免费视频| 午夜丁香综合婷婷| 79精品视频在线观看,| 婷婷涩五月天综合| 丁香婷婷少妇| 五月丁香婷成人网| 五月丁香婷婷网网网网| 色色色五月婷婷| 91.com男女操| 密臀av无码人妻精品| 99精品久久久久久久久| 色综合激情图区| 国产精品久久久爽爽爽麻豆色哟哟| 九九久久网| 欧洲综合视频| 五月综合丁香婷婷| 日日夜夜干| 欧洲亚洲精品| 婷婷五月丁香六月天亚洲综合| 久99久热只有精品国产99| 色青青五月| 成人视频九九| 日韩五月婷婷| 丁香五月天色| 欧美日本综合网| 婷婷第六色| 色情五月天小说| 就要爱综合| 亚洲热手机在线观看| sesesesezonghe| 激情文学 综合 色| 五月丁香综合激情在线观看| 婷婷 久综合| 色色日韩| 亚洲激情免费久久| 蜜臀av无码久久久久久久久| 97AV在线视频| 99久久综合| 久草 天堂| 亚洲综合婷婷| 久久久人妻人伦| 天天骑日日爽| 亚州激情网| 激情com| 婷婷丁香五月久久| 五月丁香综合久久| 亚洲精| 99re这里只有精品首页| 丁香丝袜五月| 人妻久久久久久久久久久| 九九热在线精品| 国产精品日日躁夜夜躁| 97干欧美| 99热这里全是精品| 激情第四色| 久久久精品人妻| 99热这里是精品| 色婷婷电影网| 天海翼中文字幕高| 色99xx| 亚洲精品另类| 婷婷激情在线| 五月丁香激情啪啪| 伊人大香五月天| 五月天成人网婷婷| 中文国产五月天| 天天插天天爱| 日本精品99网站| 五月天色区| 国产SUV精品一区二区6| 超碰免费人人肏| 久久久久久久久久久44| 六月婷婷激情图片| 秋霞学生妹一二级| 色欲五月婷婷| 五月天精品| 91黄操| 99久久99久久综合| 五月天丁香婷婷视频网址 | 狠狠CAO日日穞夜夜穞AV| 久久女伦| av无码电影| 久草大| 99色最新在线视频| 亚城区在线| 久久婷五月综合| 天天插天天射| 九色亚洲| 婷婷99狠狠躁天天躁中文| 99色综合网| 九九热这里只有精品12| 五月天 无码| 99综合视频| 亚洲精品无AMM毛片| 婷婷干| 性视频久久| 99re这里只有精品视频6| 美女美女美女三级色天天天天天| 99这里热| 色婷视频| 99在线一区| 久热9| 毛片新网地| 丁香五月开心亚洲| 久色| 香蕉五月婷婷| 婷婷五月天丁香花| 九九热这里只有精品一| 99爱爱网| 亚洲精品V天堂中文字幕| 第1影院之五月婷婷| 99久久亚洲精品视频| 5月丁香六月情| 亚洲色色色| 日本一级一级一级一级| 超碰免费电影| 人妻性操逼中文字幕 国产| 91精品国产综合久久密臀| 亚洲婷婷久久综合| 69精品人人人人| 亚洲免费电影2| 丁香午月AV中文字幕| 五月天 另类图片| www久| 99久久97| 久久丁香五月婷婷| 开心五月深爱婷婷| 六月婷婷综合| 欧美碰碰碰| 六月婷婷五月丁香首页| 五月婷婷丁香在线视频| 五月丁香六月在线| 亚洲第一影院高清无码网站| 99在线er热| 色99在线视频| 色色色色色色色色网站| 99久久天堂婷婷| 色情五月天视频网| 色婷婷亚洲六月婷婷中文字幕| 96丁香六月婷婷蜜桃综合久久| 97伦乱| 麻豆科斗777| 欧美色五月| 国产精品美女久久久久AV超清| 大香蕉久久草| 五月天四色房丁香| WWW,五月| 色色丁香色五月| 欧美99热| 外国碰视频网站97| 亚洲天堂制| 欧美大奶熟女噜噜噜噜| 婷婷九月在线| 激情综合丁香六| 大香蕉久久伊人婷婷五月丁香| 中文av网站| 色五月激情五月| 五月丁香激情四射| 五月激情偷拍| 国外亚洲成AV人片在线观看 | 五月天开心激情综合网| 欧美性生交XXXXX无码小说| 婷婷激情人妻| 中文国产五月天| 五月婷婷激情| 在线网黄| 婷婷色五月色| 性按摩玩人妻HD中文字幕| 精品久热| 久久色亭亭五月天| 日韩五月婷婷久久| 免费精品66| 综合色播| 91婷婷丁香五月| 狠狠色噜噜| 激情小说五月天| 久久久999精品| 播五月,色五月,开心五月播放器| 91麻豆国产三级精品福利在线观看| 日本久久网| 97热精品| 激情婷婷丁香色五月| www.色五月天.com| 天天插天天射| 五月激情啪啪| 操97免费超级视频| 综合网网欲色| 五月丁香激情婷婷综合| 色色国产| 五月丁香六月婷婷亚洲天堂网站| 九色七七| 亚洲一区二区无遮挡A片| 婷婷五月天亚洲综合| 99ri精品| 色色色色五月天| 99热99极品观看| 色色婷婷婷丁香五月天| 五月天色婷婷伊人网| 免费三级黄色| 五月丁香999| h在线看免费版在线看| 欧美黑人大吊| www激情| 站长推荐无码播放| 婷婷内射视频在线| 婷婷欧美激情| 丁香婷婷五月天在线视频| 9|在线观看视频| 天天开心AV色综合婷婷五月天| 专区无日本视频高清8| 五月亭亭六月色| 9999久久久久| 色玖玖爱| 日韩成人无码人妻| 啪啪 综合网| WWW.17C亚洲精品| 九九综合图片网| 久久A区B区| 97操资源婷婷| 99视频一区| 97人人干视频| 婷婷六月丁香久| 日本久久网| 综合综合色色| 99这里有精品| 狠狠五月天婷婷| www.夜夜操| 深夜婷婷五月丁香| 性爱久久| 激情小说五月天社区丁香| 综合激情婷婷| 青青热视频| 成人日韩欧美| 九九av| 噜噜狠狠| 丁香六月激情| 蜜臀av无码久久久久久久久| 丁香婷婷久久| 婷婷色五月激情| 九九视频在线观看| 综合五月草| 狠狠干狠狠色| 欧美搡BBBBB摔BBBBB| 天天色天天爱天天舔| 日韩中文字幕| 新激情五月天色播| 久9热在线免费观看| 色狠狠色综合| 免费观看2018www黄色操逼网站| 色播五月婷婷五月| Av免费网站在线| www.夜夜操.com| 久久加勤综合| 色情五月天首页| 五月婷婷久草| 婷婷激情九月| 天天综合 99久久婷婷| 99热在线播放| ′久久99一| 大香蕉伊人久久| 密黄站| 777米奇影视第四色| 精热在线综合网| 天天操天天插| 亚洲精品性色| 无码一区二区三区四区五区91c| 天天影视天天爽天天草| www.黄色片-久久成人国产精品在线播放-999AV| 4399在线日本A片| 天天五月丁香五月| 国产乱妇乱子在线播视频播放网站| 婷婷六月天激情影院| 婷婷久久女人| 美欧日韩国产成人在战| 九月丁香婷婷综合激情| 青柠影视免费高清电视剧| 色五月婷婷内射| 精品爆操| 丁香五月在线| 国产又黄又爽又激情不遮挡视频在线观看 | 婷婷狠狠狠爱| 免费AV在线| 婷婷五月在线综合| ..真实国产乱子伦毛片| 久久久久丁香婷婷五月天| 99久久99视频| 激情五月综合| 五月丁香五月天现场视频| 激情婷| 996er热| 婷婷五月 丁香六月| 思思99热| 五月天综合图片| 亚洲AV中文在线| 婷婷五月天综合在线| 欧美婷婷五月天综合| 丁香色影院| 婷婷99| 伊人深爱综合| 五月色丁香| 欧洲色区| 久久A V无码视频| 色婷婷偷拍| 五月激情在线| 天天爽天天爽视频| 欧美色婷婷| 97 天堂| www.夜夜操| 九九热AV| 色综合77777| www.97碰碰com| 亚洲熟妇AV综合网五月丁香伊人| 久久精品A片777777| 天天做天天爽| 婷婷在线五月天观看| 婷婷五月六月丁香| 天天干天天爽| 人人爽欧美婷婷久久久五月丁香| 色五月激情网| 91黄色五月天视频| 999热在线视频| 日日撸日日操| 超碰在线国产9| 91男人操女人视频| 日日噜噜夜夜狠狠久久丁香六月| 婷婷,五月天,丁香,第一| 色色色色色九九九九九| 五月丁香综合| 婷婷五月情天| 天天操天天爱天天日| av一区免费看| 亚洲激情在线| 五月天成人综合| 99在线观看精彩视频| 天堂网色婷婷| 国产 码在线成人网站| 激情综合网五月天| 久久亚洲精品成人无码网站导航| 国产操肏网站| 最近中文字幕大全免费版在线| 亚洲操操操| 男人综合网| 曰曰久久| 亚洲一二三网| 噜噜噜久久| 五月丁香六月色| 五月丁香少妇A| 久久精品五月| 丰满少妇乱A片无码| 国产成人av在线| 九九爱看亚洲| 秋霞性爱AV| 人人操91色| 丁香五月偷拍| 久久伦乱| 五月丁香六月婷综合成人综合| 狠狠搞五月天| 91VIP在线观看| 亚洲综合激情五月久久| 99视频在线播放大全| 色丁香影院| 激情5月婷婷狠狠干| 大香蕉九操| 97色视频网| 五月日韩中文字幕| 久久婷婷成人综合色怡春院| 色五月婷婷老师| 六月五月婷婷| 无码四色色色| 91色综合网| 婷婷五月丁香激情图片| 国产亚洲精品AAAAAAA片| 丁香婷婷啪啪| 婷婷久久色| 五月婷婷激情69| 天天爽夜夜爽夜夜爽精| 五月丁香久| 婷婷丁香五月天操逼| 免费视频在线观看的网站| 九九黄色网| 五月天激情啪啪| 99久久6| 这里只有九九精品| 久久久人妻久久久| 天天玩夜夜操| 色婷婷伦理| 99热色无码| 香蕉久久六月| 激情骚五月| 丁香五月婷婷综合激情哟哟哟| 国产日韩欧美| 天天天天天天操| 99久在线视频| 99热这里只有精品免费| 丁香五月婷婷亚洲综合精品在线| 丁香婷婷精品视频| 亚洲成人网在线观看| 久re热视频| 五月丁香A片| 五月丁香六月片| 精品一区二区三区四区五区六区| 五月激情六月宗合| 99热久草| www婷婷| 丁香五月婷久久| 伍月婷丁香花全集| hd五月婷婷在线| 五月丁香婷婷五月色| 第2色五月婷| 五月色综合| 生活片五区| 国产精品汇聚精彩第二页 - 高清完整版在线 - 青蛙AV | 人妻五月天激情开心网| 久青青久| 日本色天堂| 91精品综合久久婷婷九色| 久久婷婷青青| 99国产精品久久久久久久久久久 | 久草嫩草在线观看| 男女啪啪视频久 9| 国产精品久久久久久久久久| 91精品丝袜久久久久久| 亚洲视频99| 五月天婷婷在线视频| 九九热在线99| 激情久久五月天| 影音先锋一区二区三区| 久久久大香蕉| 五月天婷婷久久| 九九婷婷综合| 色婷婷88| 婷婷色在线观看| 91爱啪啪| 五月婷激情| 色色a| 久久久久久久人妻| 涩五月婷婷| 五月丁香综合网| 五月开心激情| 婷香五月激情视频| 99精品综合| 久99久视频| 另类图片五月天| 五月婷婷中文| 色五月网址| 日本欧美成人片AAAA| 婷婷婷婷婷婷婷婷婷婷丁香| 性色九九| 婷婷黄色网| 久久码久久无清| 丁香五月婷婷综合精品素人| 五月婷啪| 91色色色| 九九热只有这里精品| 五月 丁香 欧美| 五月欧美色色五月| 亚洲五月天综合| 五月丁香 啪啪啪| 色婷婷九月| 丁香五月天啪啪| 综合99久久天天综合| 996热re视频精品视频| 97人人干|