基于ARM+Linux的直流伺服控制系統(tǒng)設計

摘 要： 目前大多伺服控制系統(tǒng)依賴計算機實現(xiàn)，系統(tǒng)體積功耗大、成本高。針對此問題，以ARM9 S3C2440芯片和CPLD EPM570T144芯片為硬件平臺，在嵌入式Linux操作系統(tǒng)下設計了直流伺服控制系統(tǒng)。ARM實現(xiàn)控制算法，得出控制量給CPLD ，CPLD主要用作控制接口擴展和信號處理。詳細介紹了Linux設備驅動設計和伺服控制應用程序設計。實驗結果證明，系統(tǒng)能夠實現(xiàn)等速跟蹤、位置跟蹤和正弦跟蹤等控制功能，并能實現(xiàn)復雜控制算法，以滿足控制系統(tǒng)實時性和高速性要求。
關鍵詞： ARM9；嵌入式Linux；CPLD；Linux設備驅動；伺服控制

隨著數(shù)字信息技術的不斷發(fā)展，人們對伺服控制系統(tǒng)的實時性、穩(wěn)定性和復雜性的要求越來越高，單靠順序結構的軟件設計已經不容易滿足上述要求。目前很多伺服控制系統(tǒng)的控制器采用PC/104結構或依賴上位計算機，根據(jù)實際的控制系統(tǒng)需要擴展相應的控制電路，使得系統(tǒng)體積大、成本高、可靠性不易保證，且用戶交互性不好。嵌入式Linux操作系統(tǒng)由于具有代碼開源、可移植性、軟硬件可裁剪性、資源豐富及支持多種硬件平臺和接口等特點，并且從2.6版本以后的Linux實時性有了很大的提高，正被越來越多地應用于伺服控制系統(tǒng)中。通過嵌入式Linux操作系統(tǒng)對控制系統(tǒng)的軟硬件資源進行分配、調度、控制和協(xié)調，能夠充分發(fā)揮控制系統(tǒng)的性能。ARM處理器以其體積小、低功耗、低成本、高性能、文檔豐富及嵌入式軟件多等優(yōu)點而得到廣泛的應用。因此，本文以ARM9和CPLD為硬件平臺，在嵌入式Linux操作系統(tǒng)下設計了直流伺服控制系統(tǒng)。
1 硬件平臺
系統(tǒng)原理框圖[1]如圖1所示。系統(tǒng)以ARM作為主控芯片，主要負責運行操作系統(tǒng)并實現(xiàn)控制算法、人機交互和多機通信等。CPLD EPM570T144主要負責從ARM接收數(shù)據(jù)，產生相應的PWM波；接收編碼器輸出信號，并對其進行處理，得到編碼器的值，將其送給ARM，從而實現(xiàn)電機的閉環(huán)控制。CPLD和ARM之間通過地址總線(13根)、數(shù)據(jù)總線(16根)、控制總線(片選、讀寫使能信號等)與GPIO口(作為外部中斷使用)連接，即CPLD類似于ARM的一個外部存儲器(CPLD掛接在ARM的bank1存儲空間上，地址空間為0x08000000～0x10000000)，ARM和CPLD的數(shù)據(jù)交換類似于對存儲器的讀寫操作。這種總線方式擴展，使得系統(tǒng)數(shù)據(jù)交換快速、操作簡單。控制板通過JTAG、UART、USB和網口與上位機連接，在目標板和上位機之間建立交叉開發(fā)環(huán)境，可在控制板和上位機之間實現(xiàn)程序下載調試、文件傳輸和通信等，便于系統(tǒng)軟件開發(fā)和調試。

2 CPLD程序設計
CPLD程序分為電機辨向、四倍頻、編碼器脈沖計數(shù)、PWM波生成和總線數(shù)據(jù)讀寫5個模塊，如圖2所示。采用VHDL語言，依據(jù)自底向上設計的方法，以便于程序開發(fā)和移植。

采用增量式編碼器，需對編碼器輸出的ABZ碼進行處理[2]，經過辨向、倍頻、計數(shù)后得到編碼器值。ARM與CPLD之間通過雙向總線交換數(shù)據(jù)，CPLD讀取ARM寫入數(shù)據(jù)總線的數(shù)據(jù)，產生對應的PWM波。當CPLD中的編碼器值可讀后，CPLD采用中斷方式通知ARM，然后將編碼器值寫到數(shù)據(jù)總線上供ARM讀取。由于CPLD與ARM的其他外設共用數(shù)據(jù)總線，所以在CPLD對總線進行操作時要特別注意，除了CPLD往總線上寫數(shù)據(jù)外，其他時刻都應該將總線置為高阻態(tài)，以讓出總線的使用權，否則其他外設（如網口、ADC接口等）會因CPLD一直占用總線而不能正常工作。
CPLD應用計數(shù)法產生PWM波[3]，CPLD時鐘頻率為100 MHz，設置PWM總計數(shù)值為8 000。CPLD根據(jù)ARM給定的0～8 000的計數(shù)值對時鐘計數(shù)，產生兩路反相的PWM波。為防止功率放大器的H橋同一側上下同時導通，一般設置有3～5 μs的死區(qū)，本設計中設置為5 μs的死區(qū)。
3 設備驅動設計
3.1 設備驅動簡介
設備驅動是連接應用程序與硬件設備的橋梁，驅動程序為應用程序提供了接口函數(shù)，用戶在應用程序中調用相應的接口函數(shù)便可實現(xiàn)對硬件設備的操作，因此，驅動程序的開發(fā)是嵌入式系統(tǒng)開發(fā)的關鍵環(huán)節(jié)。Linux設備驅動分為字符設備驅動、塊設備驅動和網絡設備驅動[4]。本文中控制板上移植了Linux2.6操作系統(tǒng)，該操作系統(tǒng)下需設計ARM讀寫CPLD的數(shù)據(jù)及對CPLD產生的中斷信號響應的驅動，這一要求采用字符設備驅動來實現(xiàn)。應用程序通過系統(tǒng)調用對設備文件進行諸如read、write等操作時，系統(tǒng)調用通過設備文件的主設備號找到相應的設備驅動程序，然后讀取設備驅動程序中初始化的file_operations結構體，獲取相應操作（read/write等）對應的函數(shù)指針，接著把控制權交給該函數(shù)。因此，編寫設備驅動程序的主要工作就是編寫這些文件操作的接口函數(shù)，并填充file_operations的各個域。
3.2 設備驅動程序設計
為便于開發(fā)和調試，設備驅動使用模塊的方式動態(tài)加載到內核中去。加載模塊的方式與以往的應用程序開發(fā)有很大的不同。以往在開發(fā)應用程序時都有一個main()函數(shù)作為程序的入口點，而在驅動開發(fā)時卻沒有main()函數(shù)，模塊在調用insmod命令時被加載，此時的入口點為module_init()函數(shù)，在該函數(shù)中完成設備的注冊、設備文件的創(chuàng)建和相關內存及寄存器的地址映射。同樣，模塊在調用rmmod命令時被卸載，此時的入口點為module_exit()函數(shù)，在該函數(shù)中將不用的資源返還給操作系統(tǒng)，把注冊的設備、創(chuàng)建的設備文件及IO內存映射等注銷掉。在設備完成注冊和加載之后，用戶的應用程序就可以對該設備進行一定的操作，如read、write等。而驅動就是用于實現(xiàn)這些操作，在用戶應用程序調用相應入口函數(shù)時執(zhí)行相關的操作，module_init()入口點函數(shù)則不需要完成其他如read、wirte之類的功能。驅動程序需要定義和實現(xiàn)open、read、write等函數(shù)，并填充到file_operations結構中，file_operations結構把應用程序中的系統(tǒng)調用與驅動中對應的函數(shù)聯(lián)系在一起。file_operations結構體如下所示：
static struct file_operations cpld_drv_fops = {
.owner = THIS_MODULE,
.write = cpld_drv_write,
.read = cpld_drv_read,
.open = cpld_drv_open,
.release = cpld_drv_close,
.fasync = cpld_drv_fasync,
};
其中，write()函數(shù)實現(xiàn)向CPLD中寫入數(shù)據(jù)，read()函數(shù)實現(xiàn)ARM從CPLD讀取數(shù)據(jù)。設備驅動運行在內核空間，而應用程序運行在用戶空間，設備驅動程序不能直接訪問用戶空間的地址，在read()和write()函數(shù)中分別調用內核函數(shù)copy_to_user()和copy_from_user()實現(xiàn)數(shù)據(jù)的轉移。read函數(shù)實現(xiàn)讀取CPLD中的編碼器值，write函數(shù)實現(xiàn)將產生PWM波的計數(shù)值寫入CPLD中，這兩個函數(shù)實現(xiàn)了內核空間與用戶空間的數(shù)據(jù)交換。從驅動程序結構看，驅動程序由三部分組成：結構體struct file_operations及其成員函數(shù)的實現(xiàn)、設備初始化module_init()和設備注銷module_exit()。
讀寫CPLD需要對內存進行讀寫操作[5]。CPLD產生的讀中斷信號連接到ARM的GPF1口，CPLD的使能信號由ARM的GPF0產生，因此需要配置相應的寄存器。驅動程序中需要對內存和寄存器進行操作，本操作系統(tǒng)下不能直接對內存和寄存器的物理地址進行操作，需先將相應的內存和寄存器的物理地址映射到內核的虛擬地址空間，通過對映射后的虛擬地址進行操作實現(xiàn)對寄存器和內存的操作。
ARM對CPLD的讀操作采用異步通知和內核中斷方式[5]實現(xiàn)，這樣可減少系統(tǒng)開支。首先在驅動的open()函數(shù)中調用request_irq()函數(shù)注冊內核中斷，并在內核中實現(xiàn)中斷處理函數(shù)，在內核中斷處理函數(shù)中調用kill_fasyn()函數(shù)給指定的應用程序發(fā)送信號，通知應用程序CPLD中的編碼器值可讀。當CPLD無可讀中斷產生時，將read()函數(shù)放入等待隊列，主程序一直處于睡眠狀態(tài)，而不是應用程序主動去調用read()函數(shù)來等待中斷的產生，即采用異步通知方式，調用內核中的fasync_helper()函數(shù)來實現(xiàn)。當CPLD有可讀中斷產生時，在中斷處理函數(shù)中通過kill_fasync()函數(shù)，向進程發(fā)送信號SIGIO，觸發(fā)應用程序中signal聲明的異步觸發(fā)函數(shù)，使用POLL_IN表明有數(shù)值可以讀取。另外，要注意，在進入中斷服務程序后，首先通過中斷自旋鎖spin_lock_irq()關閉所有中斷，以防止其他中斷源中斷kill_fasync的工作，在中斷服務程序結束時，再通過spin_unlock_irq()打開中斷。中斷處理函數(shù)部分代碼如下：
spinlock_t lock;
static irqreturn_t eint1_irq(int irq, void *dev_id)
//中斷服務程序
{
spin_lock_irq(&lock)；//關閉中斷
kill_fasync (&eint1_async, SIGIO, POLL_IN);
//產生中斷后，驅動向應用程序發(fā)送數(shù)據(jù)可讀信號
spin_unlock_irq(&lock)；//開中斷
return IRQ_RETVAL(IRQ_HANDLED);
}
4 應用程序設計