ADT-MC020在全閉環(huán)激光打標(biāo)系統(tǒng)中的應(yīng)用
2010/2/5 11:51:00
[摘 要]∶本文介紹了基于ADT-MC020嵌入式數(shù)控控制器通過串口和PC機通信,設(shè)計通過光柵尺反饋的雙閉環(huán)控制系統(tǒng),分析了精確定位誤差的原因及其解決方法。該系統(tǒng)已用于游標(biāo)卡尺激光打標(biāo)和精確送料裝置中。
[關(guān)鍵詞]∶嵌入式 MC020 串口通信 光柵尺 雙閉環(huán) 伺服 精確定位 激光打標(biāo)
1 引言
隨著計算機技術(shù)、電子技術(shù)的發(fā)展,嵌入式控制系統(tǒng)作為裝備工業(yè)的大腦快速地被應(yīng)用到各個行業(yè)中。
嵌入式控制系統(tǒng)由于其體積小、性價比高、針對性強、抗干擾能力好等特點快速不斷地進入了數(shù)控行業(yè)各個領(lǐng)域。
游標(biāo)卡尺由于是一種精密地測量儀器,那么其生產(chǎn)的廠家對卡游標(biāo)尺本身的刻度打標(biāo)要求就非常高?,F(xiàn)代化生產(chǎn)中必須要考慮生產(chǎn)效率,而生產(chǎn)效率又與操作方便、生產(chǎn)速度等因素相關(guān)。本文設(shè)計了采用PC機上位機發(fā)控制指令,下位機是ADT-MC020嵌入式數(shù)控控制器控制伺服加光柵尺的雙閉環(huán)控制系統(tǒng),滿足了以上要求。
2 工作原理
首先在上位機(PC機,以下稱上位機)編輯好要加工的數(shù)據(jù)文件,然后通過上位機的串口向下位機(MC020嵌入式控制器,以下稱下位機)發(fā)送指令,下位機接收到正確的指令后,開始向伺服執(zhí)行機構(gòu)發(fā)出運動指令,當(dāng)伺服運行到位后,下位機通知上位機繼續(xù)發(fā)下一個命令,以此循環(huán)。
工作流程圖如圖1所示。
3 游標(biāo)卡尺激光打標(biāo)系統(tǒng)設(shè)計
(1) 上位機系統(tǒng)
上位機控制系統(tǒng)是由VC開發(fā)的控制軟件,在上位機上可以按使用者的要求,先通過一些簡單的設(shè)定,系統(tǒng)便可以生成需要的圖形。比如卡尺刻度之間的間隔,激光打的刻度線的長短,工制還是英制或兩者都有。生成好圖形客戶可以先預(yù)覽,看是否滿足要求。
在選擇好循環(huán)打標(biāo)或單次打標(biāo)后,按開始按鈕后,計算機便通過串口發(fā)出規(guī)原點命令,下位機接收到回原點命令后,馬上執(zhí)行回原點的任務(wù),當(dāng)回到原點后,發(fā)信號給上位機,上位機馬上控制振鏡和激光發(fā)生器打出0刻度線(刻度線的長短在上面生成的圖形中已經(jīng)規(guī)定),等打完0刻度線后,上位機馬上發(fā)出再走一個刻度的命令,在下位機通過一系列的調(diào)整,保證精度后,重復(fù)上面的動作。
整個系統(tǒng)控制流程結(jié)構(gòu)圖如圖2所示。
圖2 控制流程結(jié)構(gòu)圖
(2) 串口通信
① 串口通信協(xié)議
通信協(xié)議是指通信雙方共同遵守的交換數(shù)據(jù)的格式?,F(xiàn)在我們制定的通信協(xié)議只需考慮信息在線路中的傳輸規(guī)則。
本文所使用的串口通信協(xié)議如表1所示。這樣上、下位機的相互通信就得以實現(xiàn)。
表1 通信協(xié)議幀格式
② 串口通信的程序流程圖如圖3所示。
本系統(tǒng)中,上位機在得到按鈕信號或得到下位機發(fā)回到位得信號,上位機就可以隨時發(fā)出讓下位機執(zhí)行的指令;而上位機接收下位機指令是采用查詢的方式,看下位機是否有給它發(fā)新信息;
下位機MC020接收和發(fā)送信息都是利用串口中斷,當(dāng)自己接收到新信息或要向上位機發(fā)送新信息,都將進入串口中斷服務(wù)子程序。這樣利用中斷處理異步事件,使之與上位機收、發(fā)信息同步,而又不影響做其他工作。
圖3 串口通信流程圖
(3) 下位機系統(tǒng)
下位機是本系統(tǒng)中精度的控制者和保證者,它關(guān)系到游標(biāo)卡尺最后打標(biāo)是否合格。
如圖2所示,首先下位機在接收到上位機的位置命令后,經(jīng)過校驗和處理發(fā)給了伺服驅(qū)動器,伺服設(shè)成位置控制模式,伺服電機本身帶有光電編碼器,它會反饋伺服電機走的位置是否與下位機的給定值相等,進行負反饋調(diào)節(jié),這便構(gòu)成了位置環(huán)1。但位置環(huán)1只是反應(yīng)了伺服走的位置,也就是伺服電機轉(zhuǎn)的圈數(shù),但如果絲桿、導(dǎo)軌等有誤差,就不能反應(yīng)出來,即不能反應(yīng)目標(biāo)位置的最終情況,所以位置環(huán)1只是半閉環(huán)。
加上光柵尺檢測目標(biāo)的最后位置,并把這個位置反饋給下位機MC020控制器,MC020再與上位機的給定位置值進行比較,再次進行負反饋調(diào)節(jié),這樣構(gòu)成了位置環(huán)2,最終使目標(biāo)達到上位機給定的命令值的位置,從而完成精確定位。
游標(biāo)卡尺打標(biāo)的雙環(huán)精確定位流程圖如圖4所示。
圖4 雙位置環(huán)定位程序流程圖
4 位置誤差產(chǎn)生原因及解決方案
(1) 原點誤差
在運動控制中,現(xiàn)在很多機器上安裝的原點開關(guān)一般是機械式的或光電開關(guān),機械開關(guān)本身有一定的彈性變形范圍,而且用久了后彈片的彈性系數(shù)和機械磨損帶來的位置偏差都將發(fā)生變化;光電感應(yīng)開關(guān)本身有一定的感應(yīng)范圍,即左邊沿到右邊沿的范圍;而每次電機以一定的速度回到原點時,在其慣性的作用下不可能剛好停在開關(guān)的感應(yīng)邊沿上。
基于以上原因,我們可以讓電機先以一個較高的速度回到原點開關(guān)的感應(yīng)范圍內(nèi),再讓電機以一個較低的速度向離開原點的方向走,下位機控制器實時檢測,當(dāng)發(fā)現(xiàn)電機一離開原點開關(guān)馬上停止;接著讓電機以一個很低的速度向原點開關(guān)的方向走,下位機控制器實時檢測,當(dāng)發(fā)現(xiàn)電機一碰到原點開關(guān)馬上停下來。
用以上方法,既可以讓電機以高速回零,提高效率,又保證將每次回零的誤差降到最低。而對于整個系統(tǒng)來講,每次打標(biāo)的起點都一致。
(2) 控制器和伺服驅(qū)動器脈沖匹配產(chǎn)生的誤差
下位機控制器把位置值按脈沖的個數(shù)發(fā)給執(zhí)行單元伺服驅(qū)動器的寄存器中,但伺服電機以不同的速度走,走完所有的脈沖所用的時間就不同,如果在伺服電機還沒真正停穩(wěn)的時候去讀光柵尺檢測的實際位置值,再把這個偏差發(fā)給伺服,伺服降超過命令給定值。
而且由于伺服沒真正的停下來,這時去檢測,可能檢測的是一個中間值,而這個中間值有可能就在精度要求的范圍內(nèi),進而控制器跳出對精度的調(diào)整,但伺服電機還在走,當(dāng)其真正停下來時位置勢必引起偏差。
基于以上原因,基本可用兩種方法解決。第一,可以用伺服驅(qū)動器上的定位完成信號輸出給下位機控制器,讓下位機控制器知道下面伺服真正走到位了。但要注意:很多伺服驅(qū)動器并不是等所有的脈沖都發(fā)完才輸出這個信號,而是當(dāng)達到一定脈沖數(shù)時就輸出此信號,所以必須把伺服驅(qū)動器中此控制定位完成的脈沖數(shù)調(diào)到一個恰當(dāng)值。第二,就是給電機發(fā)了校正脈沖后適當(dāng)?shù)难娱L一段時間,延時后再去檢測光柵尺的實際位置,然后再去校正。
由于游標(biāo)卡尺打標(biāo)本身要求精度高,如果電機多走出幾個脈沖,那它的偏差就多幾個μm,是不允許的,所以必須控制好偏差的調(diào)節(jié)。
(3) 光柵尺的安裝即環(huán)境溫度造成的讀數(shù)誤差
本系統(tǒng)的精度就是依靠光柵尺做最后保證,那光柵尺本身的精度就至關(guān)重要。首先光柵尺的安裝要保持光柵尺內(nèi)部的玻璃刻線條與運行的導(dǎo)軌平行,光柵尺的讀數(shù)滑塊連的運動滑臺的運行軌道要與光柵尺內(nèi)部的玻璃刻線條保持平行。而支撐滑臺的導(dǎo)軌和絲桿本身的質(zhì)量自然也要有保證。
令一個方面就是環(huán)境溫度對最后測量的影響,由于溫度的變化會造成光柵尺內(nèi)部玻璃刻線條的熱脹冷縮的變化,以致造成最后讀書偏差。所以一定的溫度。
5 結(jié)束語
隨著國家制造業(yè)的不斷發(fā)展,對國家的裝備業(yè)要求也越來越高,尤其在快速定位和精度要求較高的系統(tǒng)中,對定位精度就提出更高的要求。本設(shè)計方案在游標(biāo)卡尺激光打標(biāo)中獲得了成功應(yīng)用。
參考文獻:
【1】 徐建軍主編。MCS-51系列單片機應(yīng)用及接口技術(shù)[M].北京:人民郵電出版社,2003。
【2】 郭慶鼎,王成元。交流伺服系統(tǒng)[M].北京:機械工業(yè)出版社。1996。
[關(guān)鍵詞]∶嵌入式 MC020 串口通信 光柵尺 雙閉環(huán) 伺服 精確定位 激光打標(biāo)
1 引言
隨著計算機技術(shù)、電子技術(shù)的發(fā)展,嵌入式控制系統(tǒng)作為裝備工業(yè)的大腦快速地被應(yīng)用到各個行業(yè)中。
嵌入式控制系統(tǒng)由于其體積小、性價比高、針對性強、抗干擾能力好等特點快速不斷地進入了數(shù)控行業(yè)各個領(lǐng)域。
游標(biāo)卡尺由于是一種精密地測量儀器,那么其生產(chǎn)的廠家對卡游標(biāo)尺本身的刻度打標(biāo)要求就非常高?,F(xiàn)代化生產(chǎn)中必須要考慮生產(chǎn)效率,而生產(chǎn)效率又與操作方便、生產(chǎn)速度等因素相關(guān)。本文設(shè)計了采用PC機上位機發(fā)控制指令,下位機是ADT-MC020嵌入式數(shù)控控制器控制伺服加光柵尺的雙閉環(huán)控制系統(tǒng),滿足了以上要求。
2 工作原理
首先在上位機(PC機,以下稱上位機)編輯好要加工的數(shù)據(jù)文件,然后通過上位機的串口向下位機(MC020嵌入式控制器,以下稱下位機)發(fā)送指令,下位機接收到正確的指令后,開始向伺服執(zhí)行機構(gòu)發(fā)出運動指令,當(dāng)伺服運行到位后,下位機通知上位機繼續(xù)發(fā)下一個命令,以此循環(huán)。
工作流程圖如圖1所示。
3 游標(biāo)卡尺激光打標(biāo)系統(tǒng)設(shè)計
(1) 上位機系統(tǒng)
上位機控制系統(tǒng)是由VC開發(fā)的控制軟件,在上位機上可以按使用者的要求,先通過一些簡單的設(shè)定,系統(tǒng)便可以生成需要的圖形。比如卡尺刻度之間的間隔,激光打的刻度線的長短,工制還是英制或兩者都有。生成好圖形客戶可以先預(yù)覽,看是否滿足要求。
在選擇好循環(huán)打標(biāo)或單次打標(biāo)后,按開始按鈕后,計算機便通過串口發(fā)出規(guī)原點命令,下位機接收到回原點命令后,馬上執(zhí)行回原點的任務(wù),當(dāng)回到原點后,發(fā)信號給上位機,上位機馬上控制振鏡和激光發(fā)生器打出0刻度線(刻度線的長短在上面生成的圖形中已經(jīng)規(guī)定),等打完0刻度線后,上位機馬上發(fā)出再走一個刻度的命令,在下位機通過一系列的調(diào)整,保證精度后,重復(fù)上面的動作。
整個系統(tǒng)控制流程結(jié)構(gòu)圖如圖2所示。
圖2 控制流程結(jié)構(gòu)圖
(2) 串口通信
① 串口通信協(xié)議
通信協(xié)議是指通信雙方共同遵守的交換數(shù)據(jù)的格式?,F(xiàn)在我們制定的通信協(xié)議只需考慮信息在線路中的傳輸規(guī)則。
本文所使用的串口通信協(xié)議如表1所示。這樣上、下位機的相互通信就得以實現(xiàn)。
表1 通信協(xié)議幀格式
② 串口通信的程序流程圖如圖3所示。
本系統(tǒng)中,上位機在得到按鈕信號或得到下位機發(fā)回到位得信號,上位機就可以隨時發(fā)出讓下位機執(zhí)行的指令;而上位機接收下位機指令是采用查詢的方式,看下位機是否有給它發(fā)新信息;
下位機MC020接收和發(fā)送信息都是利用串口中斷,當(dāng)自己接收到新信息或要向上位機發(fā)送新信息,都將進入串口中斷服務(wù)子程序。這樣利用中斷處理異步事件,使之與上位機收、發(fā)信息同步,而又不影響做其他工作。
圖3 串口通信流程圖
(3) 下位機系統(tǒng)
下位機是本系統(tǒng)中精度的控制者和保證者,它關(guān)系到游標(biāo)卡尺最后打標(biāo)是否合格。
如圖2所示,首先下位機在接收到上位機的位置命令后,經(jīng)過校驗和處理發(fā)給了伺服驅(qū)動器,伺服設(shè)成位置控制模式,伺服電機本身帶有光電編碼器,它會反饋伺服電機走的位置是否與下位機的給定值相等,進行負反饋調(diào)節(jié),這便構(gòu)成了位置環(huán)1。但位置環(huán)1只是反應(yīng)了伺服走的位置,也就是伺服電機轉(zhuǎn)的圈數(shù),但如果絲桿、導(dǎo)軌等有誤差,就不能反應(yīng)出來,即不能反應(yīng)目標(biāo)位置的最終情況,所以位置環(huán)1只是半閉環(huán)。
加上光柵尺檢測目標(biāo)的最后位置,并把這個位置反饋給下位機MC020控制器,MC020再與上位機的給定位置值進行比較,再次進行負反饋調(diào)節(jié),這樣構(gòu)成了位置環(huán)2,最終使目標(biāo)達到上位機給定的命令值的位置,從而完成精確定位。
游標(biāo)卡尺打標(biāo)的雙環(huán)精確定位流程圖如圖4所示。
圖4 雙位置環(huán)定位程序流程圖
4 位置誤差產(chǎn)生原因及解決方案
(1) 原點誤差
在運動控制中,現(xiàn)在很多機器上安裝的原點開關(guān)一般是機械式的或光電開關(guān),機械開關(guān)本身有一定的彈性變形范圍,而且用久了后彈片的彈性系數(shù)和機械磨損帶來的位置偏差都將發(fā)生變化;光電感應(yīng)開關(guān)本身有一定的感應(yīng)范圍,即左邊沿到右邊沿的范圍;而每次電機以一定的速度回到原點時,在其慣性的作用下不可能剛好停在開關(guān)的感應(yīng)邊沿上。
基于以上原因,我們可以讓電機先以一個較高的速度回到原點開關(guān)的感應(yīng)范圍內(nèi),再讓電機以一個較低的速度向離開原點的方向走,下位機控制器實時檢測,當(dāng)發(fā)現(xiàn)電機一離開原點開關(guān)馬上停止;接著讓電機以一個很低的速度向原點開關(guān)的方向走,下位機控制器實時檢測,當(dāng)發(fā)現(xiàn)電機一碰到原點開關(guān)馬上停下來。
用以上方法,既可以讓電機以高速回零,提高效率,又保證將每次回零的誤差降到最低。而對于整個系統(tǒng)來講,每次打標(biāo)的起點都一致。
(2) 控制器和伺服驅(qū)動器脈沖匹配產(chǎn)生的誤差
下位機控制器把位置值按脈沖的個數(shù)發(fā)給執(zhí)行單元伺服驅(qū)動器的寄存器中,但伺服電機以不同的速度走,走完所有的脈沖所用的時間就不同,如果在伺服電機還沒真正停穩(wěn)的時候去讀光柵尺檢測的實際位置值,再把這個偏差發(fā)給伺服,伺服降超過命令給定值。
而且由于伺服沒真正的停下來,這時去檢測,可能檢測的是一個中間值,而這個中間值有可能就在精度要求的范圍內(nèi),進而控制器跳出對精度的調(diào)整,但伺服電機還在走,當(dāng)其真正停下來時位置勢必引起偏差。
基于以上原因,基本可用兩種方法解決。第一,可以用伺服驅(qū)動器上的定位完成信號輸出給下位機控制器,讓下位機控制器知道下面伺服真正走到位了。但要注意:很多伺服驅(qū)動器并不是等所有的脈沖都發(fā)完才輸出這個信號,而是當(dāng)達到一定脈沖數(shù)時就輸出此信號,所以必須把伺服驅(qū)動器中此控制定位完成的脈沖數(shù)調(diào)到一個恰當(dāng)值。第二,就是給電機發(fā)了校正脈沖后適當(dāng)?shù)难娱L一段時間,延時后再去檢測光柵尺的實際位置,然后再去校正。
由于游標(biāo)卡尺打標(biāo)本身要求精度高,如果電機多走出幾個脈沖,那它的偏差就多幾個μm,是不允許的,所以必須控制好偏差的調(diào)節(jié)。
(3) 光柵尺的安裝即環(huán)境溫度造成的讀數(shù)誤差
本系統(tǒng)的精度就是依靠光柵尺做最后保證,那光柵尺本身的精度就至關(guān)重要。首先光柵尺的安裝要保持光柵尺內(nèi)部的玻璃刻線條與運行的導(dǎo)軌平行,光柵尺的讀數(shù)滑塊連的運動滑臺的運行軌道要與光柵尺內(nèi)部的玻璃刻線條保持平行。而支撐滑臺的導(dǎo)軌和絲桿本身的質(zhì)量自然也要有保證。
令一個方面就是環(huán)境溫度對最后測量的影響,由于溫度的變化會造成光柵尺內(nèi)部玻璃刻線條的熱脹冷縮的變化,以致造成最后讀書偏差。所以一定的溫度。
5 結(jié)束語
隨著國家制造業(yè)的不斷發(fā)展,對國家的裝備業(yè)要求也越來越高,尤其在快速定位和精度要求較高的系統(tǒng)中,對定位精度就提出更高的要求。本設(shè)計方案在游標(biāo)卡尺激光打標(biāo)中獲得了成功應(yīng)用。
參考文獻:
【1】 徐建軍主編。MCS-51系列單片機應(yīng)用及接口技術(shù)[M].北京:人民郵電出版社,2003。
【2】 郭慶鼎,王成元。交流伺服系統(tǒng)[M].北京:機械工業(yè)出版社。1996。
提交
查看更多評論
其他資訊
從國產(chǎn)探路者到創(chuàng)新風(fēng)向標(biāo),眾為興伺服的“進階之路”
效率與柔美,眾為興五軸聯(lián)動點膠闡釋當(dāng)代數(shù)字工業(yè)
你會有報復(fù)性需求嗎?SCARA鎖螺絲機奔你而來
持續(xù)給力!“眾為興總線方案”助推口罩生產(chǎn)按下“快進鍵”
眾為興線上培訓(xùn)開課了,首期教你機器人和視覺基礎(chǔ)知識