控制算法控制軟件的插補模塊用于實現(xiàn)機器人的運動路徑規(guī)劃。運動控制設(shè)計了三種指令MoveL、MoveC、MoveJ，分別用來實現(xiàn)直線軌跡插補，圓弧軌跡插補和關(guān)節(jié)角空間插補。機器人規(guī)劃路徑和精度選擇的不同會引起中間點個數(shù)的差異，軟件的設(shè)計上，路徑點數(shù)據(jù)的存取采用動態(tài)存取方式，以提高內(nèi)存的使用效率?？刂栖浖尿?qū)動模塊用于機器人底層的運動控制，通過調(diào)用運動控制卡提供的API函數(shù)直接驅(qū)動運動控制卡。

　　軟件采用PT模式實現(xiàn)6軸聯(lián)動，GT_PrfPt函數(shù)設(shè)置為PT模式，GT_PtData設(shè)置路徑中連續(xù)兩點的時間、位置和控制模式，適當?shù)倪x擇其控制模式可以實現(xiàn)運動的加減速，使關(guān)節(jié)運動平滑過度。機器人視覺功能對于一些目標位置多變的工業(yè)現(xiàn)場有著很強的實用性。視覺系統(tǒng)硬件如前文所述采用一款基于TMS320DM642型DSP的視頻處理卡及其配套的仿真器和CCD攝像機。

　　CCD攝相機首先采集一幅720×576像素的灰度圖像，經(jīng)過圖像處理，將圖像中的目標點提取出來。論文設(shè)計了一個與工控機的通訊協(xié)議，通過視頻處理卡上的串口將目標點信息發(fā)送至工控機，工控機上運行的機器人視覺控制模塊處理接收到的目標信息，與機器人末端位置進行比較，實時計算出距離信息，并通過運動學(xué)逆解計算出關(guān)節(jié)運動量，發(fā)送至運動控制卡以驅(qū)動各關(guān)節(jié)運動，實現(xiàn)機械臂末端跟隨目標點運動。