摘 要：針對七自由度機械臂遠程控制的需要，構建了基于TCP/IP網絡的控制系統。首先通過設計單片機系統實現本地端控制，然后運用WinSockets類創建基于TCP/IP的遠程控制程序，使連接在Internet網絡上的任意客戶端均可實現對機械臂的遠程控制。結合視頻網絡服務器，實現了對機械臂的實時監控操作。
關鍵詞：機械臂;TCP/IP;遠程控制;視頻服務器

Abstract: A tele-control system for a 7-dof robot arm based on TCP/IP network is created. AVR singlechip is adopted to build a local control system. In order to link clients and the server in the Internet web, WinSockets class is applied to program using Visual c++. It is convenience to real-time observe tele-operation combined with video network server.

KeyWords: Robot arm; TCP/IP; Tele-control; video network server

Rhino XR-2機器人[1]是一個典型的機電一體化產品，它模擬人的上肢，肩關節可從-45到+135度旋轉;肘關節可從-135到90 度旋轉;手腕可以上下90度旋轉，左右170度旋轉，是一個具有7個自由度的機械臂系統。通過適當調節各關節，該機器人能夠從指定位置抓取較小物體。為了實現遠程控制，構建了基于TCP/IP網絡的七自由度機械臂遠程控制系統，如圖1所示。通過該系統，連接在Internet網絡上的任意客戶端均可登錄指定服務器獲取操作權限實現對七自由度機械臂的遠程控制，并通過視頻網絡服務器實時監控機械臂操作結果。

圖1 七自由度機械臂遠程控制系統
1.本地端控制系統設計

首先設計本地端控制器，由于每個關節單獨由一個Brevel電機驅動，因此只要在本地端實現對各個電機的單獨控制包括啟動、停止、調速即可。

1.1基于 ZLG7289B的本地控制

ZLG7289B[2] 是周立功單片機發展有限公司自行設計的數碼管顯示驅動及鍵盤掃描管理芯片，可直接驅動8 位共陰式數碼管（或64 只獨立LED），同時還可以掃描管理多達64 只按鍵。ZLG7289B 內部含有顯示譯碼器，可直接接收BCD 碼或16 進制碼，并同時具有2 種譯碼方式。ZLG7289B 采用SPI 串行總線與微控制器接口，僅占用少數幾根I/O 口線。

本例中采用AVRmega128單片機作為微控制器，通過ZLG7289B實現對鍵盤的操作，從而觸發8個電機的不同動作，實現對機械臂的控制。AVR高端芯片MEGA128擁有53個IO口輸出，8個PWM輸出口，8個外部中斷，16位定時器與8位定時器各兩個。它采用單指令周期，處理速度快，在滿足I/O的情況下，足以滿足電機控制的運算要求。利用該單片機產生8路PWM信號通過兩個L298N驅動模塊實現8個電機的驅動。每個L298N驅動模塊包含2塊電機驅動芯片L298N、16個保護二極管、4個電源濾波穩定電容、2個輸入信號邏輯處理單元、4個控制電機輸出插座。由于每個L298N芯片控制2個電機，則每個驅動模塊可以控制4個電機，其實物圖如圖2所示。

圖2 L298N驅動模塊
為方便操作，使用了液晶顯示模塊LCMxxZK，其繪圖顯示畫面提供一個64＊256 點的繪圖區域,電源操作范圍寬（2.7V to 5.5V），此外，低功耗設計可滿足產品的省電要求同時與單片機的接口界面非常靈活。如圖3所示，利用設計的單片機控制系統，根據液晶顯示屏的提示通過鍵盤操作可以實現對機械臂的控制，同時操作結果通過液晶顯示屏反饋給操作者。

圖3 液晶屏與鍵盤
1.2基于串口通信的上位機控制

為了構建基于TCP/IP網絡的遠程控制系統，需要在本地建立服務器端控制器。本例中采用PC機作為遠程控制的服務器，同時作為單片機控制系統的上位控制器。

該上位機系統采用DB9-RS232串口線作為數據總線，通過串行通信與下位機建立聯系。PC機通過數據總線把位選、轉向、轉速等信息傳遞給下位單片機AVR Mega128，通過對I/O口置1或清零來控制相應電機的轉向，并通過改變PWM信號占空比來控制轉速。

由于數據總線的使用，各部分都相互獨立，只需要遵守相同的數據傳輸協議即可工作，使得擴展功能變得十分容易。有時候甚至不需對芯片進行重編程或電路板進行大幅度修改，只需要更換部分模塊就可以實現功能升級。在Visual C++ 6.0環境下運用串口類編寫了上位機控制程序[3]，通過該程序，可利用個人PC實現對機械臂的控制。

2.基于TCP/IP網絡的遠程控制

通過設計本地端控制系統后，可以在本地端實現七自由度機械臂的各關節速度控制，從而實現機械手運動到適當位置抓取物體，并傳送到另一位置。為了實現異地遠程控制，需要設計遠程控制系統。基于TCP/IP的以太網絡進行遠程控制是一個好的選擇。本例中構建了一個基于C/S（Client/Server）結構的遠程控制體系，該體系包含服務器端和客戶端，服務器端接收到客戶端程序發來的數據后，對數據進行處理，進而發出相應的指令通過串口通信控制主控單片機，從而控制各關節的相應動作。

服務器端程序功能如下：

（1）創建監聽Socket進行監聽，當有客戶端請求連接時建立一個新的接收Socket處理這個客戶的數據發送與接收;
（2）接收客戶端發來的數據并向客戶端返回相應信息;
（3）對接收到的數據進行處理，然后向下位單片機發送控制命令。

客戶端程序功能如下：

（1）建立與服務器程序的連接
（2）向服務器程序發送數據信息，接收從服務器程序返回的信息
（3）關閉與服務器程序的連接

在Visual C++ 6.0環境下運用WinSockets類來編寫基于TCP/IP的遠程控制程序，其中服務器端監聽程序如下。

if（Accept（＊pSocket））
｛ pDlg->m_pAcceptList.AddTail（pSocket）;
CString strAddr,strAddr1;
UINT unPort,unPort1; pSocket->GetPeerName（strAddr1,unPort1）; //得到遠程IP地址和端口號 pSocket->GetSockName（strAddr,unPort）; //得到本地IP地址和端口號
pDlg->m_strNetMsg.Format（"本地IP%s端口%d連接上遠程客戶IP%s端口%d", strAddr,unPort,strAddr1,unPort1）;
pDlg->UpdateMsgData（）;
｝
else
｛
delete pSocket;
｝
CSocket::OnAccept（nErrorCode）;

其部分界面如圖4所示：