一種面向多自由度3d打印機(jī)器人的3d打印頭機(jī)構(gòu)控制系統(tǒng)及該系統(tǒng)的控制方法
【技術(shù)領(lǐng)域】
[0001 ]本發(fā)明涉及3D打印頭控制領(lǐng)域。
【背景技術(shù)】
[0002]傳統(tǒng)熔融沉積(FDM)工藝3D打印機(jī)往往采用箱式或框式結(jié)構(gòu)，靈活性受限，無法制造出大于自身結(jié)構(gòu)尺寸的構(gòu)件，且無法直接完成受損構(gòu)件現(xiàn)場修復(fù)任務(wù)。為解決這些問題，多自由度機(jī)器人技術(shù)與3D打印技術(shù)融合勢在必行，一方面可以充分利用多自由度機(jī)器人三維立體空間運(yùn)動(dòng)的靈活性實(shí)現(xiàn)構(gòu)件的靈活制造，另一方面可以利用柔順控制算法直接實(shí)現(xiàn)受損構(gòu)件現(xiàn)場無損修復(fù)任務(wù)。目前，商業(yè)的關(guān)于FDM工藝的3D打印機(jī)控制電氣系統(tǒng)都是自成一套獨(dú)立的開發(fā)系統(tǒng)，底層程序開源不夠徹底。因此與多自由度機(jī)器人控制系統(tǒng)存在整合難度大的問題，即使花費(fèi)較大代價(jià)完成系統(tǒng)整合，也會(huì)導(dǎo)致電氣集成度低等問題。

【發(fā)明內(nèi)容】

[0003]本發(fā)明為了解決當(dāng)前商業(yè)化的關(guān)于FDM工藝的3D打印機(jī)控制器與多自由度機(jī)器人控制系統(tǒng)的整合難度大和集成度低的問題，提出了一種面向多自由度3D打印機(jī)器人的3D打印頭機(jī)構(gòu)控制系統(tǒng)及該系統(tǒng)的控制方法。
[0004]一種面向多自由度3D打印機(jī)器人的3D打印頭機(jī)構(gòu)控制系統(tǒng)包括多自由度機(jī)器人中央控制器和3D打印頭機(jī)構(gòu)控制系統(tǒng)，所述多自由度機(jī)器人中央控制器與3D打印頭機(jī)構(gòu)控制系統(tǒng)之間通過查分總線實(shí)現(xiàn)數(shù)據(jù)信息交互。
[0005]所述3D打印頭機(jī)構(gòu)控制系統(tǒng)包括:
[0006]用于隔離差分信號(hào)變換的隔離差分信號(hào)變換模塊；
[0007]用于對(duì)多自由度機(jī)器人中央控制器發(fā)送的信號(hào)進(jìn)行處理的控制處理模塊；
[0008]用于進(jìn)行數(shù)字信號(hào)隔離的數(shù)字信號(hào)隔離模塊；
[0009]用于驅(qū)動(dòng)外部電機(jī)的步進(jìn)電機(jī)驅(qū)動(dòng)模塊；
[0010]用于對(duì)3D打印頭內(nèi)部加熱棒進(jìn)行加熱的加熱模塊；
[0011]用于對(duì)3D打印機(jī)頭內(nèi)部的溫度傳感器進(jìn)行溫度采集的溫度采集模塊。
[0012]所述控制處理模塊包括:
[0013]用于多自由度機(jī)器人中央控制器與軟處理模塊實(shí)現(xiàn)數(shù)據(jù)交互的串行通信控制接口豐旲塊；
[0014]用于接收多自由度機(jī)器人中央控制器發(fā)送的數(shù)據(jù)并進(jìn)行處理的軟處理模塊；
[0015]用于根據(jù)軟處理模塊發(fā)送的控制指令向步進(jìn)電機(jī)驅(qū)動(dòng)模塊發(fā)送控制信號(hào)的步進(jìn)電機(jī)驅(qū)動(dòng)控制接口模塊；
[0016]用于根據(jù)軟處理模塊發(fā)送的加熱指令向加熱模塊發(fā)送加熱信號(hào)的加熱控制接口豐旲塊;
[0017]用于根據(jù)軟處理模塊發(fā)送的溫度采集指令向溫度采集模塊發(fā)送溫度采集信號(hào)的溫度采集控制接口模塊；
[0018]用于觸發(fā)硬件終端的定時(shí)器。
[0019]所述3D打印頭機(jī)構(gòu)控制系統(tǒng)還包括電源隔離變換模塊，所述電源隔離變換模塊包括第一 DC/DC隔離模塊、第二 DC/DC隔離模塊、第一 DC/DC變換模塊、第二 DC/DC變換模塊、第三DC/DC變換模塊、第一線性穩(wěn)壓器、第二線性穩(wěn)壓器、第一熔斷器和第二熔斷器，所述第一DC/DC隔離模塊的隔離信號(hào)輸入端、第三DC/DC變換模塊的變換信號(hào)輸入端、第一熔斷器的熔斷信號(hào)輸入端和第二熔斷器的熔斷信號(hào)輸入端同時(shí)連接外部直流電源，第一 DC/DC隔離模塊的隔離信號(hào)輸出端同時(shí)與第二 DC/DC隔離模塊的隔離信號(hào)輸入端、第一線性穩(wěn)壓器的穩(wěn)壓信號(hào)輸入端、第二線性穩(wěn)壓器的穩(wěn)壓信號(hào)輸入端、第一 DC/DC變換模塊的變換信號(hào)輸入端和第二 DC/DC變換模塊的變換信號(hào)輸入端連接，所述第二 DC/DC隔離模塊的隔離信號(hào)輸出端與隔離差分信號(hào)變換模塊的隔離信號(hào)輸入端連接，第一線性穩(wěn)壓器的穩(wěn)壓信號(hào)輸出端與溫度采集模塊的穩(wěn)壓信號(hào)輸入端連接，第二線性穩(wěn)壓器的穩(wěn)壓信號(hào)輸出端與控制處理模塊的穩(wěn)壓信號(hào)輸入端連接，第一 DC/DC變換模塊的變換信號(hào)輸出端與控制處理模塊的第一變換信號(hào)輸入端連接，第二 DC/DC變換模塊的變換信號(hào)輸出端同時(shí)與控制處理模塊的第二變換信號(hào)輸入端和數(shù)字信號(hào)隔離模塊的第一變換信號(hào)輸入端連接，第三DC/DC變換模塊的變換信號(hào)輸出端同時(shí)與數(shù)字信號(hào)隔離模塊的第二變換信號(hào)輸入端連接和步進(jìn)電機(jī)驅(qū)動(dòng)模塊的變換信號(hào)輸入端連接，第一熔斷器的熔斷信號(hào)輸出端與步進(jìn)電機(jī)驅(qū)動(dòng)模塊的熔斷信號(hào)輸入端連接，第二熔斷器的熔斷信號(hào)輸出端與加熱模塊的熔斷信號(hào)輸入端連接。
[0020]基于上述控制系統(tǒng)的控制方法為:
[0021]步驟一、由多自由度機(jī)器人中央控制器根據(jù)作業(yè)任務(wù)，完成對(duì)3D打印頭狀態(tài)監(jiān)控和送絲機(jī)構(gòu)的運(yùn)動(dòng)規(guī)劃；
[0022]步驟二、多自由度機(jī)器人中央控制器根據(jù)步驟一中完成的運(yùn)動(dòng)規(guī)劃下傳控制指令；
[0023]步驟三、由3D打印頭機(jī)構(gòu)控制系統(tǒng)根據(jù)接收到的控制指令完成出絲控制，并回傳狀態(tài)數(shù)據(jù)。
[0024]有益效果:本發(fā)明提出一種面向多自由度3D打印機(jī)器人的3D打印頭機(jī)構(gòu)控制系統(tǒng)及基于該系統(tǒng)的控制方法，采用虛擬關(guān)節(jié)法，即將3D打印頭機(jī)構(gòu)等效成多自由度機(jī)器人的末端虛擬關(guān)節(jié)方式，構(gòu)建多自由度3D打印機(jī)器人的3D打印頭機(jī)構(gòu)控制系統(tǒng)，實(shí)現(xiàn)資源優(yōu)化配置，并提高系統(tǒng)集成度。該控制系統(tǒng)包括:多自由度機(jī)器人中央控制器和3D打印頭控制系統(tǒng)兩部分。前者根據(jù)作業(yè)任務(wù)，主要完成多自由度3D打印機(jī)器人的笛卡兒空間運(yùn)動(dòng)軌跡規(guī)劃，并同步完成對(duì)3D打印頭狀態(tài)監(jiān)控和送絲機(jī)構(gòu)的運(yùn)動(dòng)規(guī)劃；后者由控制處理模塊、電源隔離變換模塊、隔離差分信號(hào)變換模塊、數(shù)字信號(hào)隔離模塊、步進(jìn)電機(jī)驅(qū)動(dòng)模塊、加熱模塊和溫度采集模塊構(gòu)成，其根據(jù)前者下傳的控制指令，完成3D打印頭的出絲控制。其中控制處理模塊是基于FPGA構(gòu)建而成，通過靈活修改串行通信控制接口模塊，可適應(yīng)具有不同串行通信協(xié)議的多自由度機(jī)器人系統(tǒng)。隔離差分信號(hào)變換模塊和電源隔離變換模塊的采用，可有效提高3D打印頭機(jī)構(gòu)控制系統(tǒng)的抗干擾能力。
【附圖說明】
[0025]圖1為本發(fā)明所述的一種面向多自由度3D打印機(jī)器人的3D打印頭機(jī)構(gòu)控制系統(tǒng)的原理示意圖；
[0026]圖2為電源隔離變換模塊的原理示意圖。
【具體實(shí)施方式】
[0027]【具體實(shí)施方式】一、結(jié)合圖1說明本【具體實(shí)施方式】，本【具體實(shí)施方式】所述的一種面向多自由度3D打印機(jī)器人的3D打印頭機(jī)構(gòu)控制系統(tǒng)包括多自由度機(jī)器人中央控制器I和3D打印頭機(jī)構(gòu)控制系統(tǒng)2，所述多自由度機(jī)器人中央控制器I與3D打印頭機(jī)構(gòu)控制系統(tǒng)2之間通過查分總線實(shí)現(xiàn)數(shù)據(jù)信息交互，
[0028]所述3D打印頭機(jī)構(gòu)控制系統(tǒng)2包括:
[0029]用于隔離差分信號(hào)變換的隔離差分信號(hào)變換模塊3;
[0030]用于對(duì)多自由度機(jī)器人中央控制器I發(fā)送的信號(hào)進(jìn)行處理的控制處理模塊4;
[0031 ]用于進(jìn)行數(shù)字信號(hào)隔離的數(shù)字信號(hào)隔離模塊5;
[0032]用于驅(qū)動(dòng)外部電機(jī)的步進(jìn)電機(jī)驅(qū)動(dòng)模塊6;
[0033]用于對(duì)3D打印頭內(nèi)部加熱棒進(jìn)行加熱的加熱模塊7；
[0034]用于對(duì)3D打印機(jī)頭內(nèi)部的溫度傳感器進(jìn)行溫度采集的溫度采集模塊8。
[0035]本實(shí)施方式所述的控制系統(tǒng)采用虛擬關(guān)節(jié)法，即將3D打印頭機(jī)構(gòu)等效成多自由度機(jī)器人的末端虛擬關(guān)節(jié)方式，構(gòu)建多自由度3D打印機(jī)器人的3D打印頭機(jī)構(gòu)控制系統(tǒng)，實(shí)現(xiàn)資源優(yōu)化配置，并提高系統(tǒng)集成度。
[0036]【具體實(shí)施方式】二、本【具體實(shí)施方式】與【具體實(shí)施方式】二所述的一種面向多自由度3D打印機(jī)器人的3D打印頭機(jī)構(gòu)控制系統(tǒng)的區(qū)別在于，所述步進(jìn)電機(jī)驅(qū)動(dòng)模塊6由兩相混合式步進(jìn)電機(jī)集成驅(qū)動(dòng)芯片及其外圍電路構(gòu)成。
[0037]【具體實(shí)施方式】三、本【具體實(shí)施方式】與【具體實(shí)施方式】一所述的一種面向多自由度3D打印機(jī)器人的3D打印頭機(jī)構(gòu)控制系統(tǒng)的區(qū)別在于，所述溫度采集模塊8由基準(zhǔn)電阻與熱敏電阻比較分壓電路、模擬信號(hào)放大電路和AD轉(zhuǎn)換電路構(gòu)成。