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