一種智能助力機(jī)械手手柄控制裝置的制造方法
【技術(shù)領(lǐng)域】
[0001]本實(shí)用新型涉及一種智能助力機(jī)械手手柄控制裝置。
【背景技術(shù)】
[0002]隨著計(jì)算機(jī)技術(shù)、機(jī)械制造技術(shù)及自動(dòng)控制理論的發(fā)展，我國工業(yè)在許多領(lǐng)域采用了機(jī)械手控制技術(shù)，尤其是近年以來，柔性制造技術(shù)和工廠的自動(dòng)化技術(shù)不斷應(yīng)用生產(chǎn)實(shí)踐，代替了許多繁重的體力勞動(dòng)，工人的勞動(dòng)條件在很大程度上得到了改善，現(xiàn)行的手柄控制裝置多采用滑動(dòng)變阻器，容易在現(xiàn)場(chǎng)出現(xiàn)故障，不利于實(shí)現(xiàn)多工作模式的切換，在物料搬運(yùn)方面，不能實(shí)現(xiàn)精確的速度及位置控制。面對(duì)臨時(shí)搬運(yùn)和碼放等情況，人機(jī)對(duì)話不完善，互動(dòng)性不好，給生產(chǎn)帶來不便。
【實(shí)用新型內(nèi)容】
[0003]本實(shí)用新型的一個(gè)目的在于解決傳統(tǒng)的人工搬運(yùn)效率低以及傳統(tǒng)機(jī)械手不能實(shí)現(xiàn)多工作模式的切換的技術(shù)問題。
[0004]為實(shí)現(xiàn)上述目的，根據(jù)本實(shí)用新型提出一種智能助力機(jī)械手手柄控制裝置，它包括手柄以及與其連接的手柄控制器，所述手柄自上而下包括與鋼絲繩連接的拉力傳感器，與拉力傳感器連接的手柄軸，所述手柄軸側(cè)壁套接手柄套，下端連接承重端，所述手柄套上安裝設(shè)定按鈕，所述手柄套內(nèi)壁與手柄軸之間設(shè)置光電開關(guān)，位移傳感器，數(shù)字加速度計(jì)；所述手柄控制器包括電源，與電源連接的單片機(jī)和與所述單片機(jī)連接的設(shè)定按鈕及光電開關(guān)外圍電路，拉力傳感器外圍電路，位移傳感器外圍電路，數(shù)字加速度計(jì)外圍電路，所述設(shè)定按鈕、光電開關(guān)與設(shè)定按鈕及光電開關(guān)外圍電路電連接，所述數(shù)字加速度計(jì)與數(shù)字加速度計(jì)外圍電路電連接，所述拉力傳感器、位移傳感器分別通過拉力放大器和位移放大器與拉力傳感器外圍電路，位移傳感器外圍電路電連接。
[0005]通過設(shè)置有操作手柄的機(jī)械手，可以實(shí)現(xiàn)在生產(chǎn)現(xiàn)場(chǎng)，人機(jī)之間展開協(xié)調(diào)配合，一同完成對(duì)現(xiàn)場(chǎng)工件按需調(diào)配、移動(dòng)。提升模式時(shí)，光電開關(guān)將手柄套相對(duì)手柄軸上下移動(dòng)作為開關(guān)量傳輸給手柄控制器，機(jī)械手系統(tǒng)即可獲知有工件需要移動(dòng)的需求，操作人員手握住操作手柄，向上或向下移動(dòng)手柄套，機(jī)械手就向上或向下移動(dòng)，位移傳感器采集手柄套相對(duì)位移量作為提升速度控制參數(shù)。
[0006]在隨動(dòng)模式時(shí)，當(dāng)操作人員手扶住工件，當(dāng)向下施力于工件時(shí)，機(jī)械手向下運(yùn)動(dòng)，當(dāng)向上施力于工件時(shí)，機(jī)械手向上移動(dòng)，期間，拉力傳感器采集施力的大小以實(shí)現(xiàn)提升速度控制。當(dāng)工件接觸地面或重量突然減小一半時(shí)，數(shù)字加速度計(jì)采集該信號(hào)，對(duì)機(jī)械手鎖住，自動(dòng)切換到提升模式。
[0007]提升模式時(shí)，結(jié)合手柄套上的設(shè)定開關(guān)是否有設(shè)定值，可實(shí)現(xiàn)位置控制模式，相當(dāng)于普通升降設(shè)備的點(diǎn)位控制，在此模式時(shí)(先設(shè)定某位置為需要到達(dá)的位置及速度)，向上或向下移動(dòng)手柄套，伺服電機(jī)編碼器記錄行進(jìn)距離，位移傳感器實(shí)現(xiàn)速度信號(hào)的提取，工件以設(shè)定速度移動(dòng)到指定位置。
[0008]另外，根據(jù)本實(shí)用新型實(shí)施例可以具有如下附加的技術(shù)特征:
[0009]根據(jù)本實(shí)用新型的一個(gè)實(shí)施例，所述電源包括外部輸入VCC24V，與VCC24V電源連接的電壓轉(zhuǎn)換芯片IC4，IC6，所述IC6輸出VCC20V電壓，所述電壓轉(zhuǎn)換芯片IC4正負(fù)輸出端跨接濾波電容C801，C802輸出VCC_5V電壓，所述IC4正負(fù)輸出端還與電壓轉(zhuǎn)換芯片IC5正負(fù)輸入端連接，電容C803跨接IC5正負(fù)輸入端，所述IC5正負(fù)輸出端跨接電容C804，C805輸出VCC_3.3V電壓，電壓轉(zhuǎn)換芯片IC4、IC5、IC6共地連接。
[0010]根據(jù)本實(shí)用新型的一個(gè)實(shí)施例，所述設(shè)定按鈕及光電開關(guān)外圍電路包括安裝在手柄套上的設(shè)定按鈕，所述設(shè)定按鈕包括兩個(gè)按鈕開關(guān)S701和S702，所述S701 —端與R701連接，所述S702 —端與R702連接，所述S701和S702 —端還分別與手柄控制器內(nèi)部的單片機(jī)連接，所述R701和R702另一端與VCC24V連接，所述光電開關(guān)的電源輸入端與VCC24V連接，信號(hào)端與手柄控制器內(nèi)部的單片機(jī)連接，所述光電開關(guān)的電源接地端和S701和S702另一端共地連接。
[0011 ] 根據(jù)本實(shí)用新型的一個(gè)實(shí)施例，所述拉力傳感器外圍電路包括芯片IC2，所述芯片IC2引腳Rg-通過電阻R420與R421串聯(lián)支路與引腳Rg+連接，引腳Vs+與電源VCC_5V連接，引腳REF與電容C416 —端、電阻R425 —端、滑動(dòng)變阻器R426 —固定端、滑動(dòng)輸入端連接，滑動(dòng)變阻器R426另一固定端與電阻R427 —端連接，電阻R425另一端與電源VCC_5V連接，電源VCC_5V與C415、R417、R418 —端連接，R417另一端分別與R419 —端、電容C412 —端、電阻R423 —端以及拉力傳感器輸入端Sig-連接，R418另一端與電容C412另一端、電阻R424 一端、電阻R422 —端以及拉力傳感器輸入端Sig+連接，R419另一端與電容C414 一端以及IC2放大器負(fù)輸入端連接，電阻R422另一端與電容C413 —端以及IC2放大器正輸入端連接，芯片IC2放大器引腳Vs-、電容C414另一端、電容C413另一端、電阻R424另一端、電阻R423另一端、電容C415另一端、R427另一端、C416另一端共地連接。
[0012]根據(jù)本實(shí)用新型的一個(gè)實(shí)施例，所述位移傳感器外圍電路包括芯片IC1，所述ICl的引腳VS+與電源VCC20V連接，引腳EXCl和引腳BIN-連接后與位移傳感器的原邊B端以及電阻R416 —端連接，引腳EXC2和引腳BIN+連接后與位移傳感器的原邊A端以及電阻R415 一端連接，引腳LEVl和LEV2通過電阻R401連接，引腳FREQl和FREQ2通過電容C401連接，引腳BFILTl和BFILT2通過C402連接，引腳AFILTl和AFILT2通過電容C403連接，引腳ACOWP-和ACOWP+分別與電阻R415另一端以及電阻R416另一端連接，電容C406支路，電阻R406與R407串聯(lián)支路分別跨接在電阻R415、R416另一端之間，引腳AIN+、AIN-分別與位移傳感器的副邊a端和b端連接，引腳AIN-通過電阻R405，AC0WP-通過電阻R408，0FF1通過電阻R402，0FF2通過電阻R403以及引腳VS-共地連接，引腳SIGOUT通過電阻R404和電容C405并聯(lián)支路與引腳FEEDBACK連接，引腳FEEDBACK通過電容C404與引腳0UTFILT連接，引腳SIGOUT通過電阻R413與運(yùn)算放大器正輸入端連接，運(yùn)算放大器正輸入端通過R414和C412并聯(lián)支路接地，電源VCC20V與電容C407、C409、R409 一端連接，C407另一端與R409另一端連接后再與C408、C410、R410 一端以及ICl引腳SIGREF連接，C408、C409、C410、R410另一端共地連接，ICl引腳SIGREF通過R411與C411、R412 一端以及運(yùn)算放大器負(fù)輸入端連接，電容C411，電阻R412另一端與運(yùn)算放大器輸出端連接，運(yùn)算放大器輸出端與手柄控制器連接。
[0013]根據(jù)本實(shí)用新型的一個(gè)實(shí)施例，所述數(shù)字加速度計(jì)外圍電路包括與數(shù)字加速度計(jì)芯片IC3連接的接口 JPl，所述接口 JPl的VCC_3.3V引腳與芯片IC3的VDD1和VDD引腳連接，接口 JPl的INTU INT2引腳與芯片IC3的引腳INTU INT2連接，接口 JP的引腳SAO通過R605接地，接口 JP引腳EX_SCL與第一 NMOS功率管漏極連接，接口 JPl的VCC_5V引腳還通過上拉電阻R601與第一 NMOS功率管漏極連接，所述第一 NMOS功率管原極與R602一端以及數(shù)字加速度計(jì)芯片IC3引腳SCL連接，所述第一 NMOS功率管柵極以及R602另一端與接口 JPl的VCC_3.3V引腳連接，接口 JPl的EX_SCL引腳與手柄控制器內(nèi)部的單片機(jī)I2C通訊；接口 JP引腳EX_SDA與第二 NMOS功率管漏極連接，接口 JPl的引腳VCC_5V還通過上拉電阻R603與第二 NMOS功率管漏極連接，所述第二 NMOS功率管原極與R604 —端以及數(shù)字加速度計(jì)芯片IC3引腳SDA連接，所述第二 NMOS功率管柵極以及R604另一端與接口 JPl的VCC_3.3V引腳連接，接口 JPl的EX_SDA引腳與手柄控制器內(nèi)部的單片機(jī)I2C通訊，所述接口 JPl第三引腳和數(shù)字加速度計(jì)芯片IC3的引腳BYP通過C604共地連接。
[0014]根據(jù)本實(shí)用新型的一個(gè)實(shí)施例，所述手柄控制器還包括與所述單片機(jī)連接的顯示器電路，所述顯示器電路包括YB0802B IXD顯示電路。
[0015]根據(jù)本實(shí)用新型的一個(gè)實(shí)施例，所述IC4為MC34063、所述IC5為TPS79333、所述IC6為LM317，所述芯片IC3為MMA8451數(shù)字三軸加速度計(jì)。
[0016]根據(jù)本實(shí)用新型的一個(gè)實(shí)施例，所述芯片ICl為AD698，所述位移傳感器為LVDT。
[0017]根據(jù)本實(shí)用新型的一個(gè)實(shí)施例，所述芯片IC2為AD623。
[0018]通過CAN通信總線技術(shù)實(shí)現(xiàn)控制數(shù)據(jù)從手柄控制器經(jīng)主控制器傳遞到伺服控制器。伺服控制器可以使伺服電機(jī)運(yùn)行于位移模式、速度模式和扭矩模式，伺服電機(jī)軸端編碼器將信號(hào)反饋到伺服控制器，與主控制器給定的控制參數(shù)比較，控制電機(jī)的速度和位置。電機(jī)驅(qū)動(dòng)器通過CAN總線接口接收由伺服控制器給定的控制信號(hào)。電機(jī)實(shí)現(xiàn)很好的無極調(diào)速。實(shí)現(xiàn)工件的提升、下降及移動(dòng)的穩(wěn)定運(yùn)行。
[0019]本發(fā)明運(yùn)用多傳感器，包括光電傳感器、位移傳感器、數(shù)字加速度計(jì)以及拉力傳