《電子技術(shù)應(yīng)用》
您所在的位置:首頁(yè) > 嵌入式技術(shù) > 設(shè)計(jì)應(yīng)用 > 基于STM32與PCAP01的激光切割頭隨動(dòng)系統(tǒng)設(shè)計(jì)
基于STM32與PCAP01的激光切割頭隨動(dòng)系統(tǒng)設(shè)計(jì)
2016年電子技術(shù)應(yīng)用第6期
王 海,張李超,周偉光
華中科技大學(xué) 材料科學(xué)與工程學(xué)院,湖北 武漢430074
摘要: 針對(duì)激光切割系統(tǒng)中,由于工件表面起伏不平和彎曲,造成切割質(zhì)量不理想或切割頭碰撞工件損傷或損壞的問(wèn)題,提出了一種基于STM32與PCAP01的激光切割頭隨動(dòng)系統(tǒng)設(shè)計(jì)。該系統(tǒng)通過(guò)PCAP01芯片獲取激光切割頭噴嘴與工件表面的板極電容值,經(jīng)卡爾曼濾波后計(jì)算出噴嘴與工件的間距,驅(qū)動(dòng)伺服電機(jī)實(shí)現(xiàn)激光切割頭與工件間距的跟蹤。實(shí)驗(yàn)表明,該激光切割頭隨動(dòng)系統(tǒng)能夠快速有效地跟隨激光切割頭與工件的間距,防止切割頭與工件發(fā)生碰撞,提高激光切割質(zhì)量。
關(guān)鍵詞: STM32 PCAP01 μCOS- 激光切割
中圖分類(lèi)號(hào): TP275
文獻(xiàn)標(biāo)識(shí)碼: A
DOI:10.16157/j.issn.0258-7998.2016.06.014
中文引用格式: 王海,張李超,周偉光. 基于STM32與PCAP01的激光切割頭隨動(dòng)系統(tǒng)設(shè)計(jì)[J].電子技術(shù)應(yīng)用,2016,42(6):52-55.
英文引用格式: Wang Hai,Zhang Lichao,Zhou Weiguang. A laser cutting head servo system based on STM32 and PCAP01[J].Application of Electronic Technique,2016,42(6):52-55.
A laser cutting head servo system based on STM32 and PCAP01
Wang Hai,Zhang Lichao,Zhou Weiguang
College of Materials Science and Engineering,Huazhong University of Science and Technology,Wuhan 430074,China
Abstract: In order to improve the quality and reliability of laser cutting system, because of the undulating surface of workpiece, a laser cutting head servo system based on STM32 and PCAP01 was designed. It used PCAP01 to get the capacitance between the nozzle on laser cutting head and the surface of workpiece. The distance was calculated by capacitance, after Kalman filtering, which was used to keep the distance between laser cutting head and workpiece. The results show the equipment has good quality and reliability.
Key words : STM32;PCAP01;μC/OS-III;laser cutting

0 引言

    在激光切割加工中,為了保證切割質(zhì)量,激光焦點(diǎn)一般應(yīng)位于被加工工件表面以下板厚約1/3處[1],以確保切口處獲得最大激光功率密度。但諸多因素[2]會(huì)使得激光焦點(diǎn)位置與理想位置發(fā)生偏移。因此在加工過(guò)程中需要實(shí)時(shí)檢測(cè)激光焦點(diǎn)與被加工對(duì)象的位置關(guān)系,并進(jìn)行調(diào)節(jié)。

    肖金陵等[3]實(shí)現(xiàn)了基于CCD相機(jī)的激光焦點(diǎn)位置控制系統(tǒng),但其系統(tǒng)結(jié)構(gòu)復(fù)雜,檢測(cè)速度慢,靈敏度低。陳和平等[4]實(shí)現(xiàn)了基于接觸式傳感器的激光切割頭隨動(dòng)系統(tǒng),但其無(wú)法加工復(fù)雜表面工件,且存在接觸磨損問(wèn)題。

    針對(duì)上述方法的不足,本文提出基于ARM微控制器STM32F407和微電容測(cè)量芯片PCAP01構(gòu)建的激光切割頭隨動(dòng)系統(tǒng),具有精度高、實(shí)時(shí)性強(qiáng)、穩(wěn)定性高、無(wú)接觸等優(yōu)點(diǎn)。經(jīng)實(shí)際應(yīng)用測(cè)試,該系統(tǒng)工作穩(wěn)定有效,具有良好的可行性和廣闊的應(yīng)用前景。

1 系統(tǒng)總體設(shè)計(jì)

    激光切割頭隨動(dòng)系統(tǒng)主要由主控制器和電容傳感器兩大模塊組成。電容傳感器模塊不斷檢測(cè)激光切割頭噴嘴和工件表面形成的平行板電容,主控制器模塊在接收到電容后將其轉(zhuǎn)換為距離信息,控制伺服電機(jī)調(diào)節(jié)保持噴嘴與工件表面的距離,從而保證了激光的焦點(diǎn)一直都在工件的合理位置。系統(tǒng)總體結(jié)構(gòu)圖如圖1所示。

qrs1-t1.gif

    其中,主控制器主要由ARM STM32F407微控制器、伺服電機(jī)驅(qū)動(dòng)電路、人機(jī)交互模塊、電源管理電路和差分轉(zhuǎn)換電路組成。電容傳感器模塊主要由PCAP01微電容測(cè)量芯片和差分轉(zhuǎn)換電路組成。人機(jī)交互模塊以觸摸屏為主要組成,提供了狀態(tài)監(jiān)控、工藝參數(shù)設(shè)置、運(yùn)動(dòng)控制等多項(xiàng)功能。

2 系統(tǒng)硬件設(shè)計(jì)

2.1 系統(tǒng)硬件結(jié)構(gòu)

    系統(tǒng)硬件以STM32F407為核心,硬件框圖如圖2所示。伺服控制模塊包括了伺服電機(jī)速度環(huán)控制的模擬量輸出、編碼器的反饋輸入以及其他控制端口。為了提高系統(tǒng)穩(wěn)定性,伺服控制模塊與STM32F407之間均采用了隔離電路;以觸摸屏為主的人機(jī)交互模塊集成了指示燈、急停按鈕和啟動(dòng)按鈕等外部硬件控制;電容傳感器主要由PCAP01微電容測(cè)量芯片和差分轉(zhuǎn)換電路組成。其中,觸摸屏、高精隔離型D/A和PCAP01分別通過(guò)RS232、SPI和PWM與STM32F407通信。

qrs1-t2.gif

2.2 電容傳感器電路

    激光切割頭噴嘴與工件表面的板極電容很小,一般都是皮法級(jí)。本設(shè)計(jì)采用德國(guó)ACAM公司專(zhuān)門(mén)進(jìn)行電容測(cè)量的電容數(shù)字轉(zhuǎn)換芯片方案PCAP01[5],其內(nèi)部集成了單片機(jī)內(nèi)核,最高電容測(cè)量精度達(dá)到6 aF,最高測(cè)量頻率達(dá)到500 kHz,并且具有低至幾個(gè)微安的超低功耗。PCAP01采集的電容信息經(jīng)內(nèi)部的單片機(jī)單元處理會(huì)以PWM的形式傳輸出去。本傳感器設(shè)計(jì)將PCAP01的PWM轉(zhuǎn)換成差分信號(hào)傳輸給主控制器。其主要電路設(shè)計(jì)如圖3所示。

qrs1-t3.gif

2.3 伺服電機(jī)驅(qū)動(dòng)電路

    伺服電機(jī)驅(qū)動(dòng)電路采用了冗余設(shè)計(jì),通過(guò)切換可兼容主流的松下、臺(tái)大等伺服電機(jī)。驅(qū)動(dòng)電路的模擬量輸出采用ANALOG公司的12位DAC芯片AD5530,其最大電壓輸出范圍為±10 V。由于系統(tǒng)采集的電容值很小,易受電磁干擾影響,而伺服電機(jī)驅(qū)動(dòng)器的干擾較大。因此伺服電機(jī)與主控制器的所有接口都進(jìn)行了隔離處理,以保證穩(wěn)定性與可靠性。其中DAC芯片的SPI接口采用了ADuM1400ARW磁耦合隔離,其他接口采用了TLP281-4光耦隔離。

2.4 電源電路

    電源電路采用通用的24 V之流開(kāi)關(guān)電源供電,通過(guò)電源轉(zhuǎn)換為系統(tǒng)提供24 V、±15 V、5 V、3.3 V五路工作電源。由于±15 V為DAC芯片的電源,5 V為電容測(cè)距模塊供電,對(duì)穩(wěn)定性要求較高,因此分別由隔離型DC-DC模塊IF2405LS和IB2405LS轉(zhuǎn)化提供。3.3 V是5 V經(jīng)LM1117-3.3V低壓線(xiàn)性穩(wěn)壓器轉(zhuǎn)換提供。

3 隨動(dòng)系統(tǒng)軟件設(shè)計(jì)

    為提高系統(tǒng)可靠性,隨動(dòng)系統(tǒng)軟件部分基于嵌入式多任務(wù)實(shí)時(shí)操作系統(tǒng)μC/OS-III[6]進(jìn)行開(kāi)發(fā)。系統(tǒng)正常工作時(shí)共調(diào)度4個(gè)任務(wù):觸摸屏信息處理任務(wù)、傳感器數(shù)據(jù)處理任務(wù)、電機(jī)控制任務(wù)、系統(tǒng)狀態(tài)監(jiān)控任務(wù),其他實(shí)時(shí)性要求高的操作均在中斷中處理。同時(shí)系統(tǒng)軟件也提供了基于STM32F407芯片ID的加密認(rèn)證服務(wù),便于系統(tǒng)的試用管理。啟動(dòng)流程如圖4所示。

qrs1-t4.gif

3.1 觸摸屏信息處理模塊

    觸摸屏采用北京迪文公司的DGUS串口屏,觸摸屏的每一個(gè)控制操作都會(huì)自動(dòng)下發(fā)一段串口信息。STM32使用UART的DMA(Directional Memory Access)功能將接收到的觸摸屏串口信息存儲(chǔ)到消息緩沖區(qū)中。觸摸屏信息處理任務(wù)會(huì)定時(shí)查詢(xún)消息緩沖區(qū),若緩沖區(qū)不為空則取出消息,解析消息內(nèi)容并作相應(yīng)處理。其中,觸摸屏信息包含幀頭、數(shù)據(jù)長(zhǎng)度、指令、數(shù)據(jù)、CRC校驗(yàn)五個(gè)字段信息。觸摸屏的消息處理流程如圖5所示。

qrs1-t5.gif

3.2 傳感器數(shù)據(jù)處理模塊

    本設(shè)計(jì)中將PCAP01芯片的有效采樣率設(shè)為1 kHz,采集的電容值以PWM占空比的形式傳輸出去。STM32在中斷中捕獲電容值信息后將發(fā)送信號(hào)量激活傳感器數(shù)據(jù)處理任務(wù),在此任務(wù)中執(zhí)行電容值卡爾曼濾波和電容值轉(zhuǎn)換為距離兩項(xiàng)任務(wù)。

3.2.1 電容值卡爾曼濾波

    由于測(cè)量的電容值為皮法級(jí),極易收到電磁干擾和切割過(guò)程中飛濺的碎屑的影響,傳統(tǒng)基于均值的濾波方式會(huì)增大延時(shí)降低系統(tǒng)調(diào)節(jié)的響應(yīng)速度,因此本模塊采用了卡爾曼濾波算法。卡爾曼濾波算法[7]是一種對(duì)動(dòng)態(tài)系統(tǒng)的狀態(tài)序列進(jìn)行線(xiàn)性最小方差估計(jì)的算法,其計(jì)算量小并可實(shí)時(shí)計(jì)算,同時(shí)能夠?qū)⒃肼晫?duì)系統(tǒng)狀態(tài)的影響以及濾波延時(shí)降到最小。其通過(guò)狀態(tài)方程和觀(guān)測(cè)方程描述一個(gè)動(dòng)態(tài)系統(tǒng),如下所示:

     qrs1-gs1-2.gif

    式(1)為狀態(tài)方程,式(2)為觀(guān)測(cè)方程。其中A為系統(tǒng)狀態(tài)轉(zhuǎn)移矩陣,H為觀(guān)測(cè)矩陣,u(k)、v(k)分別是協(xié)方差為Q和R的零均值高斯噪聲。

    卡爾曼濾波包括預(yù)測(cè)和更新兩部分,其算法流程如下:

    qrs1-gs3-6.gif

    qrs1-gs7.gif

    首先使用式(3)和式(4)分別進(jìn)行系統(tǒng)狀態(tài)預(yù)測(cè)和誤差協(xié)方差預(yù)測(cè),在利用式(5)計(jì)算增益系數(shù)后,使用式(6)和式(7)分別更新系統(tǒng)狀態(tài)和先驗(yàn)協(xié)方差。重復(fù)以上步驟,不斷完成新?tīng)顟B(tài)的預(yù)測(cè)。

    電容值卡爾曼濾波的效果如圖6所示,有效濾除了噪聲的影響,且濾波結(jié)果的延遲很小。

qrs1-t6.gif

3.2.2 電容值轉(zhuǎn)換為距離

    電容傳感器測(cè)量噴嘴與工件表面的距離基于平行板電容數(shù)學(xué)模型[8]

qrs1-gs8.gif

    由于線(xiàn)路寄生電容的影響,在實(shí)際計(jì)算距離時(shí)不能直接依據(jù)此理論模型。本設(shè)計(jì)在正常運(yùn)行前,首先進(jìn)行距離與電容關(guān)系的標(biāo)定,將標(biāo)定的數(shù)據(jù)存儲(chǔ)在STM32內(nèi)部Flash中。在濾波獲取電容值后,根據(jù)標(biāo)定的關(guān)系表進(jìn)行線(xiàn)性插補(bǔ)計(jì)算出距離。標(biāo)定時(shí)取的點(diǎn)越多越密,計(jì)算的結(jié)果越精確。

3.3 電機(jī)控制模塊

    本系統(tǒng)中,伺服電機(jī)的運(yùn)動(dòng)狀態(tài)有空走、跟隨、蛙跳3種狀態(tài)。空走狀態(tài)下處理觸摸屏的控制信息,控制切割頭點(diǎn)動(dòng)或連續(xù)運(yùn)動(dòng);跟隨狀態(tài)下通過(guò)電容傳感器獲取距離信息,根據(jù)與設(shè)定間距的差值進(jìn)行高度調(diào)節(jié),跟隨狀態(tài)下碰到下限位則進(jìn)入蛙跳狀態(tài)。蛙跳狀態(tài)下控制切割頭上移一大段距離后,重新進(jìn)入跟隨狀態(tài)。切割頭在碰到上限位時(shí),3個(gè)狀態(tài)下均將電機(jī)轉(zhuǎn)速設(shè)為0,只允許切割頭向下運(yùn)動(dòng);若碰到下限位,在空走狀態(tài)下為確保安全立即控制切割頭上移直至碰到上限位停止,而跟隨狀態(tài)下則進(jìn)入蛙跳狀態(tài)。其控制流程如圖7所示。

qrs1-t7.gif

4 結(jié)論

    本文設(shè)計(jì)了一種基于STM32和PCAP01的激光切割頭隨動(dòng)系統(tǒng),該系統(tǒng)以PCAP01為電容傳感器,以STM32F407為控制器為控制核心,完成了激光切割頭高度的跟隨。其電容的采樣率達(dá)到1 kHz,最快跟隨速度500 mm/s,動(dòng)態(tài)響應(yīng)精度0.05 mm,靜態(tài)響應(yīng)精度0.001 mm。現(xiàn)場(chǎng)測(cè)試表明,該系統(tǒng)具有可靠性高、響應(yīng)速度快、跟隨精度高、操作便利等優(yōu)點(diǎn)。該系統(tǒng)必有廣闊的市場(chǎng)和應(yīng)用前景。

參考文獻(xiàn)

[1] 朱國(guó)力,段正澄,龔時(shí)華.激光切割中的焦點(diǎn)位置檢測(cè)方法研究[J].制造業(yè)自動(dòng)化,2000,22(12):33-35.

[2] 李明.激光切割頭與工件距離檢測(cè)系統(tǒng)的研制[D].哈爾濱:哈爾濱工業(yè)大學(xué),2010.

[3] 肖金陵,虞瑤.基于CCD的激光切割焦點(diǎn)位置控制系統(tǒng)的設(shè)計(jì)與實(shí)現(xiàn)[J].光電技術(shù)應(yīng)用,2006,21(4):42-46.

[4] 陳和平,石敏,王曉輝.激光切割Z軸彈性定距隨動(dòng)系統(tǒng)的設(shè)計(jì)與實(shí)現(xiàn)[J].制造業(yè)自動(dòng)化,2014,36(10):112-114.

[5] 鄧麗莉,桑勝波,張文棟,等.基于Pcap01芯片的高精度微電容檢測(cè)系統(tǒng)設(shè)計(jì)[J].傳感器學(xué)報(bào),2013,26(8):1045-1049.

[6] LABROSSE J J.嵌入式實(shí)時(shí)操作系統(tǒng)μC/OS-III[M].邵貝貝,譯.北京:北京航空航天大學(xué)出版社,2012.

[7] KALMAN R E.A new approach to linear filtering and prediction theory[J].J.basic Eng.trans.asme,1960,82d(1):35-45.

[8] 嚴(yán)瓊.激光切割電容式Z浮微小電容檢測(cè)系統(tǒng)的研究[D].武漢:華中科技大學(xué),2011.

此內(nèi)容為AET網(wǎng)站原創(chuàng),未經(jīng)授權(quán)禁止轉(zhuǎn)載。
亚洲一区二区欧美_亚洲丝袜一区_99re亚洲国产精品_日韩亚洲一区二区
国产视频在线观看一区二区三区| 亚洲另类自拍| 欧美日韩综合久久| 欧美激情精品久久久久久蜜臀| 久久久人人人| 久久午夜av| 浪潮色综合久久天堂| 久久综合久久久| 裸体女人亚洲精品一区| 久热精品视频在线| 蜜臀久久99精品久久久久久9| 久久这里有精品视频| 美日韩精品免费| 男人的天堂亚洲在线| 欧美国产三区| 欧美日韩国产麻豆| 欧美日韩综合网| 国产精品亚洲综合一区在线观看| 国产精品午夜春色av| 国产嫩草一区二区三区在线观看| 国产欧美日韩一级| 激情久久综艺| 最新日韩在线| 一本到高清视频免费精品| 宅男精品导航| 性欧美video另类hd性玩具| 欧美专区日韩视频| 亚洲二区在线观看| 日韩午夜高潮| 亚洲欧美另类久久久精品2019| 午夜国产精品视频| 久久精品中文| 欧美大片免费观看| 欧美视频在线观看 亚洲欧| 国产精品私房写真福利视频| 国产又爽又黄的激情精品视频| 在线成人激情黄色| 亚洲美女视频在线观看| 亚洲一区国产视频| 久久精品人人做人人爽电影蜜月| 亚洲欧洲偷拍精品| 亚洲永久免费视频| 久久婷婷激情| 欧美日韩国产综合久久| 国产精品视频免费一区| 一区免费观看| 一区二区三区四区蜜桃| 欧美在线视频在线播放完整版免费观看| 最近中文字幕日韩精品 | 亚洲美女一区| 欧美亚洲网站| 欧美成在线视频| 国产精品一区视频| 亚洲国产日韩欧美一区二区三区| 一区二区三区色| 亚洲大黄网站| 欧美体内谢she精2性欧美| 国产精品天天看| 亚洲国产一区二区三区在线播| 亚洲小说春色综合另类电影| 亚洲高清av| 亚洲欧美国内爽妇网| 麻豆av一区二区三区| 国产精品美女久久久久久久| 亚洲国产高清aⅴ视频| 亚洲欧美成人在线| 夜夜爽夜夜爽精品视频| 久久久久久夜| 国产精品区一区二区三区| 亚洲福利av| 欧美一级在线播放| 亚洲一区www| 欧美黑人多人双交| 国产一区二区电影在线观看 | 国产精品成人免费精品自在线观看| 国产亚洲欧美另类中文| 夜夜嗨av一区二区三区免费区| 久久精品av麻豆的观看方式| 亚洲欧美国产77777| 欧美激情1区2区3区| 国语精品一区| 亚洲免费视频在线观看| 99国内精品| 欧美福利影院| 黄色影院成人| 先锋a资源在线看亚洲| 亚洲一区免费观看| 欧美日韩精品中文字幕| 亚洲电影观看| 久久精品一区蜜桃臀影院 | 久久精品视频导航| 欧美一区亚洲一区| 国产精品久久久久久久第一福利| 亚洲三级视频| 亚洲精品在线三区| 免费看av成人| 影音先锋日韩有码| 久久激情视频久久| 久久久久成人精品| 国产片一区二区| 亚洲一区免费在线观看| 制服丝袜亚洲播放| 欧美日韩1区2区| 亚洲经典自拍| 日韩一级大片| 欧美国产亚洲视频| 亚洲国产精品女人久久久| 亚洲国产成人午夜在线一区| 久久精品国产精品亚洲精品| 国产欧美短视频| 亚洲欧美日韩国产成人| 欧美一级久久久久久久大片| 国产精品日日摸夜夜摸av| 亚洲一区中文| 欧美亚洲综合另类| 国产精品一区二区久久久久| 国产精品99久久久久久久久久久久| 亚洲色图综合久久| 欧美天天影院| 亚洲午夜激情免费视频| 亚洲在线观看视频网站| 国产精品成人一区二区三区吃奶| 99视频超级精品| 亚洲综合色网站| 国产精品私人影院| 欧美一区二区三区的| 久久精品视频在线免费观看| 国产在线国偷精品产拍免费yy| 久久精品av麻豆的观看方式| 久久综合九色综合久99| 精久久久久久| 亚洲看片免费| 欧美日韩另类在线| 亚洲一区二区三区四区中文| 欧美尤物一区| 精品动漫3d一区二区三区免费版| 久久精品视频在线看| 欧美mv日韩mv国产网站| 亚洲伦理精品| 欧美一级片在线播放| 韩国三级在线一区| 亚洲精品资源美女情侣酒店| 欧美日韩亚洲免费| 亚洲欧美激情一区| 久久人体大胆视频| 亚洲国产精品一区二区三区| 亚洲午夜未删减在线观看| 国产精品日韩欧美| 久久激情网站| 欧美日韩1区2区| 亚洲欧美视频| 欧美不卡视频| 亚洲视频欧美视频| 久久久免费精品| 亚洲精品乱码| 欧美一区二区三区免费观看| 红桃视频一区| 在线一区亚洲| 国产婷婷色一区二区三区| 最新中文字幕一区二区三区| 欧美三区美女| 久久激情视频久久| 欧美日韩一区二区三区在线| 亚欧成人在线| 欧美日本韩国在线| 亚洲综合999| 欧美成人精品h版在线观看| 一本色道久久综合亚洲精品小说| 久久国产免费| 99国产精品久久久久老师| 欧美在线免费视屏| 亚洲区在线播放| 久久精品国产在热久久 | 午夜精品久久久久久99热软件| 激情视频一区二区三区| 亚洲一区二区三区色| 黄色成人小视频| 亚洲欧美国产毛片在线| 亚洲成在线观看| 性18欧美另类| 亚洲精品婷婷| 久久视频精品在线| 中文亚洲字幕| 欧美顶级大胆免费视频| 亚洲欧美美女| 欧美色视频一区| 亚洲欧洲一区二区三区| 国产欧亚日韩视频| 亚洲天天影视| 亚洲成人资源| 久久久久久69| 亚洲欧美日韩国产成人| 欧美日韩精品免费观看| 亚洲国产综合91精品麻豆| 国产精品视频网站| 亚洲图片在线观看| 亚洲国产天堂久久综合网| 久久精品国产v日韩v亚洲 | 蜜桃av一区二区三区| 午夜亚洲性色福利视频|