前言

工業機器人的運動學控制對系統的實時性具有很高的要求，目前主流的工業機器人都是采用專門定制的運動控制卡，加上實時操作系統，這樣既保證了數據的實時傳輸又能保證運動控制的精確執行，大大提升了整個系統的穩定性，從而提升機器人的性能。另外的一些機器人產品是采用工業PC搭載高速總線的伺服控制系統，其控制PC采用的是實時操作系統，如vxworks或者windows+RTX實時擴展平臺保證軟件運行環境的實時性，通過運動規劃和運動控制單元可以實現對總線式伺服驅動器的控制，從而達到對機器人的精確控制。采用實時操作系統來搭建機器人控制系統是一個很好的解決方案，然而，其代價也是昂貴的，由于實時操作系統的成本高，這很大程度上限制了國內工業機器人產業化發展。采用通用的操作系統消息處理機制的缺陷是不能滿足工業機器人在運行過程中高穩定性和響應快速性的要求，控制系統的上下位機之間進行頻繁地通信，實時性必然會跟不上運動控制的要求，從而大大地降低了工業機器人產業化的可能。此外，模塊化、可重構的工業機器人新型機構設計、基于實時系統和高速通信總線的高性能開放式控制系統、在高速、負載工作環境下的工業機器人優化設計、高精度工業機器人的運動規劃和伺服控制、基于三維虛擬仿真和工業機器人生產線集成技術、復雜環境下機器人動力學控制和工業機器人故障遠程診斷與修復技術等也是機器人關鍵功能部件中重點解決的核心問題。

多信息融合的機器人智能感知與人機交互智能感知與人機交互是機器人與環境、機器人與人進行融合、交互的基礎。機器人感知識別技術在高效計算與精確識別方面有著巨大的發展空間，未來智能感知與認知主要是在傳感器技術發展的基礎上，進行大量數據有效分類、歸納，并提取可靠有效信息，凝聚成反映人—機—環境交互關系的特征數據網，并結合人工智能的發展及高效能計算能力的實現，為機器人的智能化發展提供基礎保障。

運動控制器是智能機器人的執行機構，對機器人的平穩運行起著重要作用。隨著新的智能控制算法的不斷涌現，智能機器人正向著智能化方向發展，MATLAB提供了一個高性能的數值計算和圖形顯示的數學和工程計算軟件環境。這種易于使用的MATLAB環境，是由數值分析、矩陣計算、信號處理和圖形繪制等組成。在這種環境下，問題的解答表達方式幾乎和他們的數學表達方式完全一樣，不像傳統的編程那么復雜。

1控制系統結構概述

智能機器人運動控制系統是整個智能機器人的基礎，可靠的運動控制系統是智能機器人實驗設計的前提。設計智能智能機器人控制系統構成圖如圖1所示。

圖1智能機器人控制系統構成圖

移動機器人控制系統的主要內容是生成機器人的運動控制信息，控制機器人的運動。軌跡跟蹤是移動機器人需要完成的任務之一，其典型工作過程為機器人運動控制器根據規劃好的路徑生成機器人的運動控制信息，控制機器人完成相應的移動，完成規劃路徑的跟蹤。運動控制過程中用到的輸入信息包括底層超聲波測距模塊提供的障礙物距離信息，電機碼盤提供的機器人的位置、速度信息，以及全景攝像機、單目視覺攝像機采集并經過處理后的視頻信息等。

智能機器人的車載處理器和上位機作為處理中樞，接收激光、超聲波等測距模塊提供的障礙物距離信息，全景、雙目視覺提供的視覺信息。結合上位機中的預設功能，通過控制驅動電機控制機器人完成相應動作。

2主控板軟件設計

主控板硬件完成模塊管理、設備通訊及機器人定位脈沖檢測等內容。在實際應用中，主控板硬件還負責超聲波測距的軟件管理，因為功能為超聲波測距軟件設計。

主控板硬件中只有主控板控制器需要進行軟件設計。主控板控制器TMS320LF2407A的主要任務是超聲波測距的軟件設計管理，余下基本都是一些基本設置內容，包括電機碼盤的正交編碼脈沖檢測。初始選定TMS320LF2407A作為主控板控制器是考慮到此控制系統可以作為以后機器人應用的平臺，可以在TMS320LF2407A里嵌入實時系統，提升系統性能，方便接口開發。

主控板控制器的軟件設計內容包括模塊初始化、串口通訊、正交編碼脈沖檢測和超聲波測距軟件。這里介紹模塊初始化串口通訊和正交編碼脈沖檢測等內容。

圖2主板控制器程序流程圖

程序流程圖如圖2所示，復位向量地址為程序入口。然后程序進行初始化。初始化內容包括擴展方式、溢出方式、DARAM、倍頻、JTAG等基本配置。另外還有使用的相關I／0121的設置、程序使用相關定時器的設置、程序使用相關中斷的設置和串口通訊的相關設置。這些配置都是控制器使用的基本配置流程。初始化之后會開啟相關的中斷程序，隨后進入超聲波測距程序，并一直循環。中斷服務程序處于就緒狀態，一旦有中斷發生，中斷服務程序立即執行。

在TMS320LF2407A的所有程序中，需要對其串口的數據發送和接收程序做說明。異步通信使用三條線(地線、發送線、接收線)連接采用RS232格式的終端。發送各位依次為一個起始位、1～8個數據位、可選的一個奇偶校驗位、1~2個停止位。因此串口通訊能夠傳輸的最大的數據單位為8位，即一個字節。在設計中控制器和各終端會有各種類型的數據交流，如整形數據和浮點數據，因此需要對串口發送和接收的數據進行數據轉換。

考慮四個字節的單精度浮點數的數據傳輸，因為串口每次最多只能傳輸一個字節，所以只需要把每個四字節浮點數的存儲數據轉換成字節形式發送即可，設計中采用強制轉換的方式完成。需要注意的地方在于TMS320LF2407A是16位芯片，因此，在TMS320LF2407A中，數據存儲均是以16位整形的數據形式存儲的，用戶對于數據的處理應該都是以16位整形數據為基礎的，所以不能將浮點數強制轉換成字節數組進行處理。例如對4字節浮點數的發送來說，首先應該將浮點數強制轉換為2個整形數。2個整形數的處理方式完全一樣，只不過在存儲地址上是字節數組的高低位不同。

對于正交編碼脈沖的檢測，TMS320LF2407A具有獨立的正交編碼脈沖單元，只要對單元寄存器進行簡單設置即可得到機器人驅動輪的運行方向和距離參數。TMS320LF2407A將這些數據通過串口發送到上位機，由上位機建模，對數據加以處理后得到機器人的位姿信息。

3電機驅動軟件設計

電機驅動軟件完成電機的驅動控制和閉環調速。驅動控制使用的是電機驅動主控芯片STCl2C4052AD的片內PWM外設單元，生成的PWM信號經過電機驅動芯片驅動電機，可以通過調節PWM占空比來調節加載在電機上24VDC電壓的占空比，從而調節電機轉速。PWM占空比由片內8位的PWM控制寄存器進行控制，該寄存器取值范圍為0,--255，分別代表PWM信號占空比從l到0的連續變化。同時STCl2C4052AD接收電機光電碼盤的脈沖信號，利用片內時鐘計算出電機運行速度，通過速度控制算法完成電機的閉環調速。

電機驅動及閉環調速軟件算法流程圖如圖3所示。

圖3電機驅動控制器程序流程圖

4結論

智能機器人運動控制系統設計，重點在于運動控制模塊的設計，包括軟件設計和電機驅動程序的編寫。運動控制系統的軟件設計主要是對機器人速度和位置的控制，核心是對電機的控制，本論文中選取改進的PID控制算法為了讓雙電機同步，加入了同步的PID算法，并做了相應的改進，為驗證改進效果，又做了改進PID控制算法的仿真與簡單PID算法的比較。實驗結果表明改進的PID算法能夠滿足運動控制需求。