一種危險品處理機器人機械手控制系統設計方案

　　（2）IO 口：DSP 的數字I/O 口模塊具有控制專用I/O 和復用引腳的功能，可以輸出輸入高低電平信號，根據其功能將其設計成開關量輸出，輸入，并用其控制繼電器，作為控的開關。開關量輸入只要用電阻分壓即可，開關量輸出使用光耦隔離，本設計用的光耦PC817，比較適合DSP 使用。當DSP 輸出高電平時繼電器吸合，CNETA1 和CNETA2 兩腳導通繼電器電路圖見圖2：

圖2 繼電器電路圖

　?。?）QEP 電路：DSP 的每個時間管理器都有一個正交編碼器脈沖（QEP）電路。當QEP電路被使能時可以對CAP1/QEP1 和CAP2/QEP2（對于EVA 模塊）引腳上的正交編碼輸入脈沖進行解碼和計數。正交編碼脈沖電路可用于連接光電編碼器以獲得旋轉機械的位置和速率。伺服電機控制器需要使用QEP 電路，由于一個伺服電機控制器需要控制4 臺伺服電機，所以碼盤信號使用74153 芯片選擇輸入，同時碼盤的每路信號都有正負兩根線通過運放放大后再到74153 選擇后輸入DSP，碼盤選擇電路見圖3：

圖3 碼盤選擇電路

　　其中W/R#/IOPC0 為使能信號，XINT1/IOPA2 和XINT2/ADCSOC/IOPDO 構成選擇信號，74153 通過選擇信號的選擇碼選擇一對信號從7 腳和9 腳輸出給DSP。其他硬件電路設計包括電源、串口、CAN 總線和DSP 外圍接線等都是典型的設計。

　　4、軟件設計

　　機械手控制的三塊控制器之間的DSP 通過CAN 總線進行通信?？傮w設計思想是使用一塊DSP 作為總控制器通過RS232 總線接收遙控端的指令，并通過CAN 總線將相應的指令發送給液壓、伺服控制器中的DSP，從而實現其控制。液壓控制系統用于控制回轉平臺的旋轉以及大臂、小臂的升降。該系統通過一塊DSP的CAN 模塊接收總控制器發出的指令，并根據接收到的指令產生相應的6 路PWM 信號以控制電液比例閥的6 路輸出。其中每兩路控制一個動作的兩個方向，有3 路IO 口控制繼電器的開關來控制泵，溢流閥，以及電源的開關，同時將位置傳感器的回饋信號經過A/D 采樣返回給DSP，進行的死循環控制。

　　伺服電機控制系統用于控制伸縮臂的伸縮，手爪的旋轉、俯仰以及夾持操作。該控制器通過CAN 總線接收總控制器指令并根據指令控制兩路獨立的PWM 輸出，通過硬件電路轉化成0-5V 輸出，作為加速信號，通過IO 口控制電機的電源以及換向。通過碼盤和轉角傳感器的回饋信號經過A/D 采樣返回給DSP，從而實現了相應的死循環。

三、結束語

　　整個機器人車現在已完成，經過一個月的安裝調試，機械手完全符合設計要求，達到如下技術指標：

　　最大作業幅度約2.5m；

　　最大作業深度：地下1m；

　　最大作業幅度下夾持提升力≤80kg；

　　最大夾持彈藥直徑160mm；

　　目前國內還沒有這種專業的處理危險品的機器人批量生產，本產品的成功完成為將來的批量生產奠定了堅實的基礎，市場潛力巨大。