新聞中心

        EEPW首頁 > 嵌入式系統 > 設計應用 > 基于ARM的APT控制系統設計

        基于ARM的APT控制系統設計

        作者: 時間:2011-10-08 來源:網絡 收藏
        2.4 JTAG接口電路

        本文引用地址:http://www.104case.com/article/150130.htm

          采用公司提出的標準20腳JTAG作為仿真調試接口,JTAG信號的定義及與LPC2124的連接如圖4所示。圖中,JTAG接口上的信號nRST,nTRST與整個系統的復位電路連接,以達到與共同復位的目的。

          2.5 電機控制及驅動

          通過設置LPC2124的PWMMR0,PWMMR6寄存器來設置輸出PWM的周期及占空比,從而控制轉臺的運行速度。電機驅動采用DMD402型二相步進電機驅動器,該驅動器可提供整步、半步、8-16檔細分共三種運行模式。另外,通過比較捕獲單元接收通過光電編碼器反饋產生的正交編碼信號,經程序處理后得到電機的當前運行速度,再對速度進行調節。

          2.6 LCD顯示器及鍵盤

          利用點陣式液晶顯示器實現中文提示界面,增強了人機交互性。設計中采用128×64的點陣LCD,使用內藏T6963C作為控制器。另外,使用4×4矩陣鍵盤作為用戶輸入。

          3 軟件設計

          主要由掃描、捕獲和跟蹤三部分組成,下面是這幾部分程序設計的介紹。

          3.1 掃描及捕獲部分

          上電復位運行后,程序先完成各部分的初始化工作,顯示歡迎界面,并提示用戶輸入轉臺運行速度及掃描步長,接著程序開始執行光柵螺旋掃描算法。光柵螺旋掃描算法示意圖如圖5所示,圖中每個小圓代表一個信標掃描子區,每個子區以正方形方式重疊。設每個子區的直徑為信標發散角α,則掃描步長為:

          以步長α0在不確定區域內搜索目標,直到捕獲到信標光斑,然后轉入跟蹤狀態。

          3.2 增量式PID控制的跟蹤算法

          PID控制算法包括位置式PID控制算法和增量式PID控制算法。在實時中常用增量式PID控制算法,其公式為:

          式中:△u(k)為輸出的控制量;q0=KP;q1=KP(TS/TI);q2=KP(TD/TS)分別為比較項、積分項和差分項的系數;TS為采樣時間,對于不同的控制系統,TS各不相同,要根據實際調試經驗來確定,該實驗中TS為0.15 s。由式(1)可知,只要貯存最近的三個誤差采樣值e(k),e(k-1),e(k-2)就可以計算出△u(k),從而實現位置和速度的反饋控制,完成穩定跟蹤。

          3.3 系統流程圖

          由上分析,可得到系統流程圖如圖6所示。

          4 測試結果及結論

          經實驗測試,整個系統最高功耗約為20 W,轉臺轉動速度范圍為0.2~0.8(°)/s,跟蹤精度按照標準差計算,最小約達20.69μrad,最快響應時間可達200 ms。利用Philips公司生產的芯片LPC2124作為控制核心來進行設計與開發,從測試結果可以看出,系統功耗較低,精度基本上滿足了控制系統的要求,具有較大的實用價值。



        上一頁 1 2 下一頁

        評論


        相關推薦

        技術專區

        關閉
        主站蜘蛛池模板: 五峰| 定兴县| 安义县| 轮台县| 绿春县| 永和县| 方山县| 兖州市| 准格尔旗| 嘉禾县| 聊城市| 会理县| 霍林郭勒市| 兖州市| 海阳市| 东至县| 曲沃县| 玛纳斯县| 敦煌市| 天全县| 通山县| 福安市| 江城| 德阳市| 金门县| 东乡| 横峰县| 元朗区| 分宜县| 晴隆县| 鄂尔多斯市| 神木县| 大庆市| 桑植县| 吴堡县| 高雄市| 山阴县| 利津县| 华容县| 益阳市| 赤壁市|