1、    基于多軸運動控制卡的伺服控制系統研究    基于多軸運動控制卡的伺服控制系統研究    類別：傳感與控制      1系統概述：以工控機為核心，結合現有使用的控制系統及交流變頻器和伺服電機的種類，針對焊接機器人用數控焊接變位機的控制問題，應用研華三軸運動控制卡pcl-832作為控制核心，建立了機器人用數控焊接變位機的高精度控制系統。 研究分析了焊接變位機的位置控制精度、速度和運動軌跡的控制過程，給出了負載變化

2、和速度變化的位置控制結果，其結果滿足與弧焊機器人配合使用的精度要求。 2系統配置：基于多軸運動控制卡的伺服控制系統硬件組成如圖1所示：系統包括：1）pc總線工控機。選用基于總線的工控機ipc-610，該機擁有標準16位數據總線及組態靈活的板塊化系統結構，可根據需要配置板卡。2）三軸交流伺服運動控制卡。三軸交流伺服運動控制卡pcl-832集成了碼盤計數器和12位的/輸出，使用數字微分分析技術dda(digital differential analysis)，實現了高精度位置控制。特殊設計的同步信號保證三軸的同步控制，可以完成三軸線性插補或兩軸圓弧插補計算，1ms伺服控制更新，12位模擬量輸出，

3、滿刻度為±10。能夠實現精確位置控制，而且每軸都有其獨立的位置控制芯片，可以實現三臺交流伺服電機的完全獨立控制。本文的數控焊接變位機系統僅使用了其中的兩個通道。3）開關量輸入/輸出板。開關量輸入/輸出板包括pcl-724和pcld-885。本系統選用的pcl- 724是數字i/o卡，24通道，實現內置plc功能。通過它與機器人通訊，驅動pcld-885繼電器輸出板實現繼電輸出功能，主要用于與外部焊接控制器、傳感器的通訊、控制器面板指示燈開滅以及錯誤報警等。4）伺服驅動裝置、位置檢測裝置、執行機構和氣缸定位裝置。3控制系統設計3.1 位置控制過程1）數字微分分析(dda)dda插補控制

4、過程是pcl-832卡工作的核心，見圖2。為了協調控制多軸伺服系統，各軸同時從t1時刻開始發送位置控制給定信號，同時在t2時刻結束給定信號的發送。t1與t2之間的時間區間定義為一個dda循環。循環時間由軟件設定。dda循環中的每一個脈沖代表伺服電機轉動度，即代表一個位置給定。可以在軟件中動態地設定每個dda循環中的脈沖數，每個dda循環中的脈沖總數就反映了在該循環中位置改變的總量。對交流變頻器連續的脈沖輸出，在宏觀上表現為平穩的位置改變。將脈沖發往+或-通道決定了電機的轉向，以上的所有工作均由卡上內置的運動芯片完成，僅需在一個dda循環開始前將位置信息寫入運動控制芯片的緩沖區而已。dda循環時

5、間代表了控制脈沖序列的開始與結束時間段，為了保證多軸的協調控制，所有的軸使用了同一個dda循環時間。軟件設定dda循環時間可由以下公式(1)計算：dda循環時間=0.512ms×寄存器中預設置 (1)寄存器中的預設置可以通過向dda寄存器的地址中寫入值的方法實現，由于dda寄存器是12位寄存器，因此寫入的最大值為4095，而最小值規定為2。根據式(1)，可知dda循環時間的設置范圍為12000。dda循環時間越短，則控制軟件的實時性越好，但如果dda循環時間取得太小，其占用率太高，則其它實時控制模塊無法正常運行，故各實時任務的執行頻率應依據其優先級和最壞情況下的運行時間來選取。2）位

6、置閉環控制過程 pcl-832卡使用比例閉環控制獲得可靠的控制效果。卡中內建了速度反饋環和偏移量機制來消除在輸入很小時而產生的靜態誤差。圖3為pcl- 832運動控制卡的功能模塊示意圖。dda發生器通過+和-通道產生連續的給定脈沖。此控制脈沖與編碼盤產生的反饋脈沖在比較器中進行比較，其結果送入比例控制器后，由比例控制器輸出控制脈沖，控制脈沖送入誤差計數器，誤差計數器實時驅動/轉換單元，完成閉環位置控制。當dda循環發生器被軟件激活后，在下一個dda循環開始的上升沿，pcl-832將產生一個中斷，在中斷程序中，將dda脈沖緩沖區中的預設值送入dda發生器。數目為個脈沖的脈沖序列將在下一個dda循

7、環中產生。在控制軟件中，必須在當前dda循環完成前，將預設值送入dda脈沖緩沖區，否則在下一個dda循環中將沒有脈沖輸出。dda發生器產生的脈沖與反饋的碼盤脈沖經比較器比較后送入誤差計數器。根據轉動方向的不同，誤差計數器的輸出上升或下降，由于誤差計數器直接驅動/輸出，因此/的輸出隨誤差計數器的輸出變化而變化，使變頻器驅動電機做出相應的響應。當整個控制過程完成后，誤差計數器的值應該為零。在非正常情況下，比如碼盤電源掉電，這時反饋信號丟失，那么誤差計數器中的值將會持續上升，電機轉速會越來越快，最終導致危險的發生。為了避免這種情況的發生，誤差計數器規定了其最大上限值為4095，如果誤差計數器中的實際

8、值超過了該上限值，意味著系統工作異常，pcl-832卡產生溢出信號并鎖定任何操作，保證了系統的安全性。3.2 運動速度的控制數控焊接變位機有兩種到位方式。第一種方式為點到點方式，這種方式用于工件位置變換，從位置一到位置二只是精確地控制定位精度，而不管從位置一到位置二按照什么軌跡運行，按照什么速度變化。為了提高生產率，一般先以較高的速度運行，在接近目標位置時，經13級減速，使之慢速趨近目標點，減小定位誤差。在此過程中，對運行速度不做控制，僅限定運行速度低于設計轉速即可。第二種工作方式為軌跡工作方式，這種方式用于焊接狀態。一般情況下變位機的運動用于將工件上的焊縫變位到水平或船型位置，但在焊接較大的

9、管-板或管-管焊縫時需要多次變位方能焊完一條焊縫，增加了接頭數量，影響焊縫質量。為了實現連續焊接，這時可讓機器人焊槍不動而讓變位機旋轉實現連續焊接，這種狀態下不僅要求具有準確的定位功能，而且要求運行的速度是可控的，對于不同的工件使用不同的焊接規范。由于自動焊的焊接速度影響焊接熱輸入和焊接熔深等指標，因此運行速度的均勻性對焊縫質量有較大的影響，這就要求對速度進行高精度的控制。在dda循環中，每次插補結束后，控制裝置向每一個運動軸輸出基準脈沖序列，每個脈沖代表了最小位移，脈沖序列的頻率代表了軸的運動速度，而脈沖的數量表示移動量。在dda控制過程中，影響運行速度主要有兩個因素。一是dda循環間隔時間

10、，即粗插補的時間周期;二是每一個dda控制周期內所發出的控制脈沖數。根據控制精度要求，已經將粗插補時間周期定為5ms，因此在系統中影響速度的因素主要為每個dda控制周期內所發出的脈沖數，每個dda控制周期內所發出的脈沖數愈多，則運行速度愈快，只要控制每個dda循環的脈沖數就可控制運行速度。雖然在每一個dda控制周期內仍然是根據偏差變化的變速控制，但由于dda粗插補時間周期非常短(ms級)，因此在運動的宏觀表現上是平滑的勻速運動。4控制系統運行結果4.1 速度控制結果圖4和圖4分別為固定dda循環時間5ms條件下，實驗得出的每個dda循環中輸出脈沖數與傾斜軸和旋轉軸轉速之間的對應關系。由實驗結果

11、可以看出，在固定dda循環時間內，每個dda循環中輸出的dda脈沖數與轉速是嚴格的線形關系。在變位機的額定速度范圍內，傾斜軸的速度控制相對誤差最大為0.309%。旋轉軸的速度控制相對誤差最大為1.827%，完全滿足焊接時對速度均勻性的要求。 4.2 位置控制結果精確的位置控制對于焊接機器人用數控焊接變位機是十分重要的。影響位置控制精度的主要外部因素有負載變化和運行速度等。為了檢測數控焊接變位機的位置控制精度，本文在不同條件下對焊接變位機的到位精度進行了實測(注：實驗中用光電編碼盤的反饋信號作為到位精度的標準，配合錐銷插孔檢測。光電編碼盤為25000個脈沖/轉，系統中的4倍頻后可達到100000

12、個脈沖/轉)。1) 負載變化。進行了從空載到負載200kg的位控精度實驗。在實驗過程中，讓變位機在各個工作角度示教5個點，然后讓其由第一點依次運動到第五點，這樣的實驗按不同負載共做了5組。結果表明，負載的變化對精度的影響較小，變位機的到位精度控制在±1個脈沖之間。2)速度變化。粗插補時間周期定為5ms，傾斜和旋轉兩軸的每個dda控制周期內所發出的脈沖數按照1，5，10，15和20個分為5個組，測量任意兩個示教位置的到位精度，實驗結果表明，運行速度對位置精度有一定影響，速度越快精度越差，但在變位機設計速度范圍內，到位精度控制在±3個脈沖之間。綜上所述，數控焊接變位機的位置控制

13、精度總體可以做到小于或等于3個位置脈沖，由此可知其理論位置控制。相對誤差為3/100000=0.0003%(變位機運行在360°以內)。絕對誤差為3×3.14×1000/100000=0.0942()(工作臺邊緣，工作臺直徑為1000()。可見其定位精度在工作臺邊沿處理論值可達到±0.1。由于到位誤差通過檢測碼盤反饋而得到，而碼盤反饋檢測不到由于齒輪間隙所造成的誤差，因此這部分誤差是檢測不到的。為了檢測系統的實際到位誤差，進行了錐銷插孔檢驗(錐銷和錐孔偏差5個脈沖，錐銷就不能完全插入)，不同位置、速度和負載進行了多次試驗，錐銷均能完全插入，因此可知工作臺邊沿定位精度5×3.14×1000/100000=0.157()。4.3 焊接實驗為了驗證整個控制系統的