掃描二維碼
隨時隨地手機(jī)看文章
1 驅(qū)動電路及測速方法
1.1 總體結(jié)構(gòu)及驅(qū)動電路
系統(tǒng)的整體結(jié)構(gòu)框圖如圖l所示。
本設(shè)計采用的LMD18200的真值表如表1所列。通過ARM的I/0口(例如D口的DO~3)來控制電機(jī)的工作狀態(tài)。
1.2 測速方法
ARM沒有捕獲外部脈沖的計數(shù)器,它的定時器是用來計算內(nèi)部脈沖的。碼盤輸出信號接外部中斷處理程序(EINTl)并設(shè)置上沿觸發(fā)變量,在中斷中設(shè)置一全局變量i,用i++累加。設(shè)置定時器timer0,使它O.36 s產(chǎn)生1次內(nèi)部定時器中斷。當(dāng)一個定時器周期完成時引發(fā)定時器中斷,在timer0中斷中讀出i的值,即得到O.36 s內(nèi)碼盤轉(zhuǎn)動所產(chǎn)生的脈沖數(shù);接著將i清零,為下一個定時器周期捕獲脈沖作準(zhǔn)備。此時timer0自動重載,下一次碼盤計數(shù)開始。
1.3 測量精度分析
智能機(jī)器人選用的光碼盤精度為256線,即256脈沖/轉(zhuǎn)。電機(jī)減速比為1:71,車輪半徑R為6 cm,車輪間距為41.1 cm。車輪轉(zhuǎn)一圈所產(chǎn)生的脈沖數(shù)n=71×256=18 176,可以得到每個脈沖之間的距離d=27πR/n=2×3.14×0.06/18 176=0.207×10-4m,即每個脈沖對應(yīng)的控制精度達(dá)0.02 mm??紤]到負(fù)載變化(例如負(fù)載變化車輪變形等機(jī)械誤差)的影響,理論值與實際值會出現(xiàn)誤差,因此在控制精度d前乘以一個修正系數(shù)k。表2為機(jī)器人直線行走的實驗數(shù)據(jù)??梢钥闯?,k為1.10誤差較小,最接近真實值,因此該值就是所需的比例系數(shù)。
2 速度調(diào)節(jié)
一般的PID調(diào)節(jié),當(dāng)偏差E較大時(如啟動或大幅度提速時),由于積分的作用會產(chǎn)生很大的超調(diào)量,使系統(tǒng)振蕩,因此選用積分分離的方法,開始時取消積分作用,直到被調(diào)量相差不多時才引入積分作用。具體步驟如下:
①設(shè)定一個值a>0,E(m)一R(m)一M(m),其中R(m)為給定值,M(m)為測量值;
②當(dāng)E(m)≥a時,采用PD控制,可以避免過大的超調(diào),又可以使系統(tǒng)有較快的響應(yīng);
③當(dāng)E(m)≤n,即偏差值E(m)比較小時,采用PID控制,可以保證系統(tǒng)的精度。
使用積分分離方法后顯著降低了被控變量的超調(diào)量并縮短了過渡時間,使調(diào)節(jié)性能得到改善。
3 驅(qū)動設(shè)計
本系統(tǒng)的驅(qū)動設(shè)計如圖2、圖3、圖4所示。
設(shè)備驅(qū)動程序是操作系統(tǒng)內(nèi)核與機(jī)器硬件之間的接口。它作為應(yīng)用和實際設(shè)備之間的軟件層,為應(yīng)用程序屏蔽了硬件的細(xì)節(jié)。對于應(yīng)用程序,硬件設(shè)備只是一個設(shè)備文件,應(yīng)用程序可以像操作普通文件一樣對硬件設(shè)備進(jìn)行操作。設(shè)備驅(qū)動程序是Linux內(nèi)核的一部分,它實現(xiàn)以下的功能:對設(shè)備初始化和釋放,把數(shù)據(jù)從內(nèi)核傳送到硬件和從硬件讀取數(shù)據(jù),讀取應(yīng)用程序傳送給設(shè)備文件的數(shù)據(jù)和回送應(yīng)用程序請求的數(shù)據(jù),檢測和處理設(shè)備出現(xiàn)的錯誤。用到的結(jié)構(gòu)如下:
設(shè)備打開的時候就會調(diào)用dcmotor__open函數(shù)進(jìn)行申請中斷號。帶內(nèi)存管理的單元的地址映射,設(shè)置B端口的2、3引腳為PWM輸出,端口D配置為電機(jī)使能剎車制動引腳。
以下所有的函數(shù)都是在ioctl()中實現(xiàn)的。在Dcmo—tor_Start里調(diào)用timer0_2_3_start(),設(shè)置timer0為接收兩路電機(jī)的碼盤信號,并檢測電機(jī)速度;timer2、timer3提供2路PWM輸出,并設(shè)置定時器自動重載。具體實現(xiàn)如下:
Select_Speed可以動態(tài)選擇要運行的速度。它是用戶的接口,用戶可以調(diào)用該函數(shù)把速度值傳到驅(qū)動從而控制電機(jī)。例如,在應(yīng)用程序中執(zhí)行ioctl(fdl,
timer0中斷是核心程序,它可根據(jù)PID的調(diào)節(jié)值來改變占空比。為了便于隨時改變占空比的值可定義兩個全局變量tmp2、tmp3,通過把它們的值寫入TCMPB來改變占空比。
在All_Forward、All_Back、All_Stop中,通過設(shè)置端口DO~3的高低電平,實現(xiàn)前進(jìn)、后退、停止;在Left_Curve、Right_Curve中,設(shè)置左右輪的旋轉(zhuǎn)方向,使兩輪旋轉(zhuǎn)方向不同,再根據(jù)差速在應(yīng)用程序中給定預(yù)定時間,以達(dá)到轉(zhuǎn)彎效果。
4 結(jié) 論
利用ARM和Linux操作系統(tǒng)實現(xiàn)智能機(jī)器人的閉環(huán)控制是可行的,而且可以充分利用ARM的強(qiáng)大功能實現(xiàn)其他智能模塊的擴(kuò)展。
學(xué)習(xí)Linux動態(tài)鏈接庫是一個繞不開的話題,我們今天就一起來看一下什么是動態(tài)鏈接庫、動態(tài)鏈接庫有什么好處、如何編譯出一個動態(tài)鏈接庫等幾個關(guān)于動態(tài)鏈接庫的幾個基本概念,廢話少說咱們直接開始
關(guān)鍵字: Linux 靜態(tài)鏈接庫 動態(tài)鏈接庫下一代LinuxONE服務(wù)器擴(kuò)展了IBM幫助行業(yè)客戶實現(xiàn)可持續(xù)目標(biāo)的能力,花旗銀行就是很好的例子 北京2022年9月14日 /美通社/ -- IBM(紐約證券交易所:IBM)于美國東部時間9月13日發(fā)布其下一...
關(guān)鍵字: IBM Linux X86 數(shù)據(jù)中心為了使得多種設(shè)備能通過網(wǎng)絡(luò)相互通信,和為了解決各種不同設(shè)備在網(wǎng)絡(luò)互聯(lián)中的兼容性問題。
關(guān)鍵字: Linux 網(wǎng)絡(luò)包北京2022年8月26日 /美通社/ -- 雙碳目標(biāo)的實現(xiàn)或許任重道遠(yuǎn),但是低碳、可持續(xù)的理念已經(jīng)滲透到我們生活工作的方方面面。持續(xù)整個夏季的異常高溫,以及四川等地限電,讓許...
關(guān)鍵字: IBM 可持續(xù)發(fā)展 AI Linux