|
雙超聲波數(shù)據(jù)融合的兩輪機器人平衡行進策略研究簡要研究了動輪自平衡機在分娩和分娩中應(yīng)用中存在的問題，以及其結(jié)構(gòu)點和姿態(tài)調(diào)平的控制策略。提出了一種基于雙超聲測距數(shù)據(jù)融合的平衡運行策略，用于故障保護機的平衡與調(diào)諧操作。通過將雙超聲數(shù)據(jù)與平衡計算方法相結(jié)合，在Arduino主控制器上實現(xiàn)自平衡姿態(tài)控制，認為對雙超聲傳感器數(shù)量進行了處理。通過以下方法保證機器的自平衡運行。同時在機器人的操作過程中加入PID控制算法，調(diào)節(jié)機器人的操作狀態(tài)，加快機器人信號誤差的處理速度。試驗和仿真結(jié)果表明，該策略是有效可行的，雙超聲自流平機能保持較好的平衡姿態(tài)，其進度控制系統(tǒng)和基本方向控制系統(tǒng)也是有效可靠的。具有較好的穩(wěn)定性和平衡協(xié)調(diào)性。在平衡方法的控制下，雙超聲波機不僅實現(xiàn)了調(diào)平前進，還實現(xiàn)了運行策略下的調(diào)平后退和方陣方向控制下的調(diào)平轉(zhuǎn)彎。有一個廣泛的可用的前視圖。 0 引言 在復(fù)雜、狹窄的大轉(zhuǎn)角工作環(huán)境下，兩輪自平衡移動式機器人可以靈活、快捷地執(zhí)行任務(wù)。這種移動式機器人兩輪共軸，機身重心置于輪軸重心上方，可憑借前后運動保持機身的相對平衡，實現(xiàn)動態(tài)平衡的直立行走。由于具有體積小、運動靈活、適應(yīng)地形變化能力強等優(yōu)點，兩輪自平衡移動式機器人可完成一些狹小環(huán)境內(nèi)的任務(wù)[1,2]。在復(fù)雜環(huán)境下能對環(huán)境高效感知和及時調(diào)整自身姿態(tài)，是自平衡機器人的必備功能。由于單一的傳感器（比如超聲波傳感器）感知能力有限 ，因此需要由多個傳感器交互實現(xiàn)有效協(xié)調(diào)，提高工作效率，同時在不同的應(yīng)用空間與任務(wù)空間中實現(xiàn)多傳感器數(shù)據(jù)融合[3,4]。 為改進兩輪自平衡移動式機器人的性能，提出了兩輪自平衡機器人姿勢平衡和行進策略，利用雙超聲波測距檢測平衡與行進特征，通過不斷檢測收集超聲波傳感器與地面的距離，進行數(shù)據(jù)濾波融合，以提高兩輪自平衡機器人的控制效果[6_7]。雙超聲波檢測提高了控制精度和集成度，在保證良好的平衡姿態(tài)和移動控制效果的前提下，有效降低了整體生產(chǎn)成本，并運用配套的數(shù)據(jù)融合處理算法，實現(xiàn)了對平衡姿態(tài)與行進姿態(tài)的調(diào)控。 1 雙超聲波姿態(tài)平衡動力學(xué)模型 兩輪自平衡移動式機器人的基本平衡控制原理為：當檢測到車體產(chǎn)生傾斜時，對主控系統(tǒng)通過檢測得到的數(shù)據(jù)進行融合、得出矯 正 的 角 度 值 與 輸 出 的占空比。 自平衡機器人主要通過驅(qū)動2個輪子的電機所產(chǎn)生的轉(zhuǎn)動力矩來控制機身傾斜方向的速度〜通過控制電機控制機身平衡姿態(tài)的調(diào)整，讓兩個輪子朝機身頃斜倒下的方向運動，進而保持機身的動態(tài)平衡 。平衡控制過程中，直接控制量為輪子的轉(zhuǎn)動力矩[8]。 若雙超聲波機器人作直線運動為輪軸半徑，沒為偏離Z軸的角度大小，θ為機器人運動的位移， V=θwr 為速度。假設(shè)不變θ，則速度在Z、F軸上可表示為： 由式（1)得速度模型：
自平衡機器人受力分析圖如圖1 所示。圖 1 中，〇為輪軸中心，P 為機身重心，機 體 質(zhì) 量 為 〜 重 力 加 速度 為 g ，機軸傾角為a ，超 聲 波 A 直射到地面的距離為A ，超聲 波B 直射到地面的距離為Lb，重心距機身下的平臺的距離為L 。設(shè)機體以加速度a 向一邊傾斜，則受到水平方向的最優(yōu)慣性合力為：
圖 1 自平衡機器人受力分析圖 2 雙超聲波測距控制方案 2 .1 超聲波測距原理與誤差調(diào)整 采用時間差測距的方式來完成距離測量，超聲波傳感器發(fā)射端向探頭正方向發(fā)射特定頻率的超聲波，內(nèi)部電路的定時器在發(fā)射超聲波時開始計時。超聲波發(fā)射與回響檢測時序圖如圖2 所示。 發(fā)射電路會根據(jù)所給的脈沖發(fā)出特定頻率的超聲波 ，超聲波碰到被測物界面則會被反射回接收端。文獻 [9]采用了超聲波傳感器接收探頭接收到反射波后定時器停止計時的方法，進而得出超聲波發(fā)射和接收回波的時間差L 超聲波在傳播介質(zhì)中的傳播速度為c(在空氣中為340 m/s)。通過計算，得出 從TXD端到被測界面之間的距離s 為 ：
由于超聲波頻率較高，可滿足多種用途的測量需要 。但在低維度空間中，超聲波測量會受到周邊溫度、自身響應(yīng)冗余、回波遲緩、傳播介質(zhì)等因素的影響。超聲波在固體中傳播速度最快，液體次之，在氣體中傳播速度最慢。聲 速 c 的表征速度與傳播介質(zhì)的溫度有關(guān) 。為了實現(xiàn)超聲波傳感器的精確測量，文獻[9]提出在硬件中設(shè)置溫度補償電路，以補償因溫度變化而帶來的聲速誤差。如果環(huán)境溫度變化不明顯，則無需設(shè)置溫度補償。 對于超聲波發(fā)出速度有：
式中T。=273.16℃ ，溫度傳感器正常工作的溫度范圍為（ -40~80℃） 在本系統(tǒng)中，假設(shè)恒定不變，V0=331.45 m/s。由于在態(tài)中各個接收器波頭滯后誤差與硬件電路延遲比較一致，故渡越時間用相同變量可表示為：
由于超聲波的測量精度的影響文獻[9]、文獻[10]提出，定時器真正測量的不是從TXD發(fā) 射 到 RXD接收到回波的時間，而是超聲波模塊已進行溫度補償后的一個上升沿觸發(fā)電平的輸出時間。如果超聲波模塊A 的觸發(fā)點沒有被主控控制觸發(fā)，而是模 塊 B 的觸發(fā)點被觸發(fā)后發(fā)射超聲波，并 且 被 模塊A接收到返回信號，或者超聲波模塊A和超聲波模塊B同時觸發(fā)，但都接收到彼此的信號，都會造成信號干擾 ，使下個周期內(nèi)TXD端口在某個不確定的時段發(fā)出一個高電平脈沖輸出，從而增大測量誤差[10]。 2 . 2 超聲波數(shù)據(jù)融合平衡算法
式中：L為機身前后的2個超聲波模塊A 、B 間的直線距離;A 為平衡點尚度。 在自平衡機器人基于雙超聲波的檢測中，假設(shè)采樣周期為100ms，在 A:時刻獲取超聲波實測值a、6,并結(jié)合(K - 1) 時刻的距離預(yù)測值。根據(jù)測量的預(yù)測協(xié)方差S對&時刻的測量值進行濾波估計修正，進而對(K+1) 時刻的距離進行預(yù)測。 測距獲取的平衡角度模型如圖3 所示。
圖 3 測距獲取的平衡角度模型 在估計平衡姿態(tài)機器人的運動狀態(tài)時，機器人的超聲波傳感器坐標采用極坐標系。設(shè)系統(tǒng)的狀態(tài)向量E (k )為:
系統(tǒng)平衡的狀態(tài)表達式為：
由于超聲波測距的采樣周期￡為300 ms，而機器人保持平衡的運動速度較為平緩，所以在局部時間段內(nèi)設(shè)定調(diào)整過程為近似勻速運動，x方向的運動方程為 ：
取前一個采樣周期內(nèi)速度的均值或者前兩個狀態(tài)周期內(nèi)的速度均值，得 ：
由式（14)可得平衡系統(tǒng)的狀態(tài)方程為：
經(jīng)過PID數(shù)據(jù)整定后的PWM輸出方程為：
基于Arduino的雙超聲波機器人平衡驅(qū)動系統(tǒng)經(jīng)過PID調(diào)整后，輸出實現(xiàn)姿態(tài)的平衡。具體的超聲波雙向測距定位平衡模型如圖4 所示。由模型圖可得測量值Z(k)為 ：
圖 4 雙向測距定位平衡模型 由于各狀態(tài)變量的誤差符合均值為〇的高斯分布 ，故平衡策略下的測量方程為:
式中： C 為測量系統(tǒng)的表征參數(shù)，當系統(tǒng)為多測量系統(tǒng)時 ，C 為矩陣;F0 為測量系統(tǒng)在&狀態(tài)下的噪聲誤差。由平衡系統(tǒng)在極坐標下的雙超聲波測距徑向距離和融合后偏差方向角的測量數(shù)據(jù)可得：
測速碼盤對電機編碼器產(chǎn)生的PWM脈沖進行記數(shù) ，監(jiān)測機身的位移與輪子的速度。根據(jù)超聲波傳感器和姿態(tài)換算監(jiān)測車體運動姿態(tài)信號，經(jīng)過雙超聲波數(shù)據(jù)融合流程，文獻[11 ]通過相關(guān)的控制算法計算出輸出控制電壓的數(shù)值大小，對雙超聲波的2 個驅(qū)動電機進行控制 ，進而調(diào)整車體平臺的行進姿態(tài)與平衡位置，從而使機身保持良好的運動協(xié)調(diào)性和平衡狀態(tài)[11,12]。 2.3 控制方案與行進策略 Arduino如 今已被運用到各個領(lǐng)域 ，是一款使用Atmel Atmega328微處理控制器的開源控制板。其開發(fā)操作界面和搭建外設(shè)環(huán)境簡易，有 0~13個數(shù)字模擬I/O、0~5 個 Analog I/O,控制效果顯著。 自平衡機器 人 采 用 超 聲 波 電 路Arduino為核心控制模塊，電機驅(qū) 動模塊為L298N ，電機為TT馬達，并以2個HC-SR0 4 作為超聲波測距模塊，采 用 7.4 V/2200 mAh鋰電池供電。電位器用于平衡點設(shè)置與PID中的調(diào)試，方便數(shù)據(jù)的更新與調(diào)試，有效減少了開發(fā)時間與生產(chǎn)成本。 雙超聲波自平衡機器人的行進控制主要通過PWM占空比輸出控制電機轉(zhuǎn)速大小，進而調(diào)整角度值的偏差，使得角度值趨近系統(tǒng)平衡零點。 控制部分由無線藍牙遙控的代碼實現(xiàn)，功能實現(xiàn)為“前進狀態(tài)"、“后退狀態(tài) ”、“左轉(zhuǎn)狀態(tài) "、“右轉(zhuǎn)狀態(tài)”。從程序初始化參數(shù)設(shè)置可以看出，雙超聲波自平衡機器人的行進控制方案是先調(diào)整平衡點和PID設(shè)定系數(shù)，然后調(diào)整左右電機的PWM輸出 ，從而實現(xiàn)行進角度的控制與電機控制[13]。 3 試驗與仿真 雙超聲波機器人運用了主控Arduino,以簡單、快捷的編程實現(xiàn)與I/O 接口連接，通過雙超聲波傳感器進行環(huán)境測距定位，并利用控制算法進行機器人姿態(tài)平衡控制。在試驗驗證方面，通過仿真顯示超聲波采集到的回聲檢測數(shù)據(jù)。由超聲波接收端接收到的回聲檢測波形圖可知，平衡系統(tǒng)的姿態(tài)搖擺幅度不大，基本處于平衡零點上下，具備基本穩(wěn)定性與數(shù)據(jù)的可計算性。 假設(shè)2 個超聲波傳感器經(jīng)過互補濾波后，換算出的角度數(shù)據(jù)為，超聲波采集數(shù)據(jù)為s，超聲波傳感器測距換算出的偏差角度值相對加速度的因子為L 前一次超聲波傳感器經(jīng)過濾波后的角度數(shù)據(jù)為M2，增益選擇固定值為g 。濾波后 的角度數(shù)據(jù)為realM，最后得出融合出的角度數(shù)據(jù)。 試驗結(jié)果證明，雙超聲波自平衡機器人能有效保持平衡，在平衡算法控制下能平衡行進;可實現(xiàn)行進策略下的平衡后退和方向控制下的平衡轉(zhuǎn)彎，穩(wěn)定效果好。 4 結(jié)束語 參考文獻： 班寧產(chǎn)品匯總 |
