一種軟關機控制電路及機械臂裝置的制造方法
【專利摘要】一種軟關機控制電路及機械臂裝置,電路與機械手臂的驅動器連接,包括連接在電源端口和所述驅動器之間的開關模塊、與所述電源端口連接的電源按鍵及控制所述機械手臂運動和復位的控制器,所述控制器的檢測端口接所述電源按鍵,所述控制器的輸出端口接所述開關模塊;其中,所述控制器檢測到所述電源按鍵斷開時,控制所述機械手臂復位后,再控制所述開關模塊關斷。通過控制器檢測電源開關的狀態(tài),當判斷其為斷開狀態(tài)時,可以控制機械臂復位后再斷開電源,避免機械臂受重力影響,關節(jié)處力矩較大,機械臂會自由下落,可能會造成機械臂或外部設備損壞,該方案簡單可靠,成本低。
【專利說明】
一種軟關機控制電路及機械臂裝置
技術領域
[0001]本實用新型涉及軟關機控制領域,特別是涉及一種軟關機控制電路及機械臂裝置。
【背景技術】
[0002]傳統(tǒng)機械臂斷電后,電機處于失鎖狀態(tài),機械臂關機可以自由活動。如果機械臂掉電前水平伸出較長,受重力影響,關節(jié)處力矩較大,機械臂會自由下落,可能會造成機械臂或外部設備損壞。
[0003]工業(yè)解決方案一般是選用帶剎車功能的電機,掉電后電機處于鎖死狀態(tài),不會在重力影響下自由下落。此種方案,帶剎車功能的電機,對于低成本桌面級機械臂應用,主要存在電機體積大,成本高等問題。
【實用新型內(nèi)容】
[0004]本實用新型目的在于提供一種軟關機控制電路及機械臂裝置,旨在解決傳統(tǒng)機械臂的鎖死功能成本高,電機體積大的問題。
[0005]本實用新型提供了一種軟關機控制電路,與機械手臂的驅動器連接,包括連接在電源端口和所述驅動器之間的開關模塊、與所述電源端口連接的電源按鍵及控制所述機械手臂運動和復位的控制器,所述控制器的檢測端口接所述電源按鍵,所述控制器的輸出端口接所述開關模塊;
[0006]其中,所述控制器檢測到所述電源按鍵斷開時,控制所述機械手臂復位后,再控制所述開關模塊關斷。
[0007]優(yōu)選地,還包括第一二極管,所述第一二極管的陽極接所述電源端口,陰極接所述電源按鍵的一端。
[0008]優(yōu)選地,所述電源端口、所述開關模塊及所述第一二極管均為多個,每個所述電源端口分別接入電壓,并分別通過所述第一二極管接到所述電源按鍵,還分別通過所述開關模塊接所述驅動器。
[0009]優(yōu)選地,還包括電源轉換模塊,所述電源轉換模塊接在所述電源按鍵和所述控制器的檢測端口之間。
[0010]優(yōu)選地,還包括指示燈,所述指示燈與所述電源轉換模塊的輸入端或輸出端連接。
[0011]優(yōu)選地,還包括第二二極管及限流電阻,所述第二二極管的陽極接所述電源轉換模塊的輸出端,所述第二二極管的陰極接所述開關模塊的控制端,且所述第二二極管的陰極通過所述限流電阻接所述控制器的輸出端口。
[0012]優(yōu)選地,所述開關模塊包括第一匪OS管,所述第一NMOS管的漏極接所述電源端口,源極接所述機械手臂的驅動器,柵極接所述控制器的輸出端口。
[0013]優(yōu)選地,所述開關模塊包括第二匪OS管和第一PMOS管,所述第一PMOS管的源極接所述電源端口,漏極接所述機械手臂的驅動器,柵極接所述第二NMOS管的漏極,所述第二NMOS管的源極接地,所述第二NMOS管的柵極接控制器的輸出端口。
[0014]優(yōu)選地,所述控制器為單片機芯片或DSP芯片。
[0015]本實用新型還提供了一種機械臂裝置,包括多節(jié)機械手臂及驅動該機械手臂運動的驅動器,還包括權利要求上述的軟關機控制電路。
[0016]上述的軟關機控制電路及設有該電路的機械臂裝置,通過控制器檢測電源開關的狀態(tài),當判斷其為斷開狀態(tài)時,可以控制機械臂復位后再斷開電源,避免機械臂受重力影響,關節(jié)處力矩較大,機械臂會自由下落,可能會造成機械臂或外部設備損壞,該方案簡單可靠,成本低,避免了使用帶剎車功能的電機造成體積大的問題,符合桌面級機械臂的應用需求。
【附圖說明】
[0017]圖1為本實用新型較佳實施例中軟關機控制電路的電路示意圖;
[0018]圖2為圖1所示軟關機控制電路中開關模塊的第一實施方式電路示意圖;
[0019]圖3為圖1所示軟關機控制電路中開關模塊的第二實施方式電路示意圖。
【具體實施方式】
[0020]為了使本實用新型要解決的技術問題、技術方案及有益效果更加清楚明白,以下結合附圖及實施例,對本實用新型進行進一步詳細說明。應當理解,此處所描述的具體實施例僅僅用以解釋本實用新型,并不用于限定本實用新型。
[0021]請參閱圖1,本實用新型較佳實施例中的軟關機控制電路可用于機械臂裝置,機械臂裝置包括多節(jié)機械手臂及驅動該機械手臂運動的驅動器100。
[0022]軟關機控制電路與機械手臂的驅動器100連接,包括連接在電源端口11和所述驅動器100之間的開關模塊12、與所述電源端口 11連接的電源按鍵13及控制所述機械手臂運動和復位的控制器14,所述控制器14的檢測端口 PowerOFF_detect接所述電源按鍵13,所述控制器14的輸出端口 PowerOFF_contrο I接所述開關模塊12。
[0023]其中,所述控制器14檢測到所述電源按鍵13斷開時,控制驅動器100驅動所述機械手臂復位后,再控制所述開關模塊12關斷;所述控制器14檢測到所述電源按鍵13接通時,控制所述開關模塊12導通,并控制驅動器100驅動所述機械手臂工作。
[0024]本實施例中,電源按鍵13使用自鎖式按鍵,可使得電路被觸發(fā)后并自鎖在該狀態(tài)下,不會隨意跳變??刂破?4為單片機芯片或DSP芯片。
[0025]軟關機控制電路還包括第一二極管Dl,所述第一二極管Dl的陽極接所述電源端口11,陰極接所述電源按鍵13的一端。第一二極管Dl用于將電源端口 11的電壓接同到電源按鍵13上,并通過該電源案件輸送到后級電路。由于二極管具有單向導通的特性,可對電源端口 11輸入的電源作防干擾保護。
[0026]本實施例中,電源端口11、所述開關模塊12及所述第一二極管Dl均為多個,每個所述電源端口 11分別接入電壓(電壓值可以相同也可以不同),每個所述電源端口 11并分別通過所述第一二極管Dl接到所述電源按鍵13,還分別通過所述開關模塊12接所述驅動器100。如此,控制器14可以同時控制該多個電源端口 11和驅動器100之間的供電。
[0027]軟關機控制電路還包括電源轉換模塊15,所述電源轉換模塊15接在所述電源按鍵13和所述控制器14的檢測端口?0¥61"(^?_(16丨601:之間。電源轉換模塊15用于將電源端口 11輸入的電源電壓轉換成符合控制器14端口要求的電源電壓,以及符合能驅動開關模塊12通斷的電壓。本實施例中,電源轉換模塊15為電壓轉換芯片。
[0028]軟關機控制電路還包括指示燈16,所述指示燈16與所述電源轉換模塊15的輸入端或輸出端連接。指示燈16接通在電源按鍵13的后端,可以用于指示電源案件是否接通。
[0029]軟關機控制電路還包括第二二極管D2及限流電阻R1,所述第二二極管D2的陽極接所述電源轉換模塊15的輸出端,所述第二二極管D2的陰極接所述開關模塊12的控制端,且所述第二二極管D2的陰極通過所述限流電阻Rl接所述控制器14的輸出端口 POWer0FF_control。第二二極管D2用于將電源轉換模塊15輸出的電源電壓單向導通到開關模塊12,在所述控制器14的輸出端口 PowerOFFjontrol的未輸出關斷信號之前,第二二極管D2輸出的電源電壓可以使開關模塊12保持導通,將電源端口 11的電源接通到機械手臂的驅動器100。
[0030]請參閱圖2,在一個實施例中,所述開關模塊12包括第一匪OS管Ml,所述第一NMOS管Ml的漏極接所述電源端口 11,源極接所述機械手臂的驅動器100,柵極接所述控制器14的輸出端口 PowerOFFjontrol。請參閱圖3,在另一個實施例中,所述開關模塊12包括第二匪OS管M2和第一PMOS管M3,所述第一PMOS管M3的源極接所述電源端口 11,漏極接所述機械手臂的驅動器100,柵極接所述第二匪OS管M2的漏極,所述第二匪OS管M2的源極接地,所述第二 NMOS管M2的柵極接控制器14的輸出端口 PowerOFF_contro I??梢?,控制器14的輸出端口 PowerOFFjontrol輸出的高電平為開關模塊12的導通信號,低電平為開關模塊12的關斷信號。
[0031]請繼續(xù)參閱圖1,下面以舉例說明本軟關機控制電路的工作原理。
[0032]所述機械臂可能有兩路電源輸入,12V和5V,一個電源按鍵13控制兩路電源。
[0033]閉合電源按鍵13時,控制器14的檢測端口 PowerOFF_detect和端口 PowerOFF_status變高電平,開關模塊12導通,機械臂控制器14上電。
[0034]機械臂控制器14上電后,控制器14的輸出端口 PowerOFF_controI輸出高電平。機械臂的驅動器100正常工作。
[0035]斷開電源按鍵13時,控制器14的檢測端口 PowerOFF_detect變低電平,控制器14的輸出端口 PowerOFF_control和端口 PowerOFF_status仍保持高電平,機械臂控制器14仍處于上電狀態(tài)。
[0036]機械臂控制器14檢測到電源按鍵13斷開信號(控制器14的檢測端口 POWer0FF_detect變低電平),機械臂的驅動器100控制機械臂運動到復位狀態(tài),復位狀態(tài)為機械臂收回到力矩最小狀態(tài),此狀態(tài)機械臂水平伸出較小,重力力矩小,不會自由落下。
[0037]其后,控制器14的輸出端口 PowerOFF_control輸出低電平,端口 PowerOFF_status變低電平,開關模塊12斷開,機械臂的驅動器100掉電。機械臂實現(xiàn)軟關機。
[0038]上述的軟關機控制電路及設有該電路的機械臂裝置,通過控制器14檢測電源開關的狀態(tài),當判斷其為斷開狀態(tài)時,可以控制機械臂復位后再斷開電源,避免機械臂受重力影響,關節(jié)處力矩較大,機械臂會自由下落,可能會造成機械臂或外部設備損壞,該方案簡單可靠,成本低,避免了使用帶剎車功能的電機造成體積大的問題,符合桌面級機械臂的應用需求。
[0039]以上所述僅為本實用新型的較佳實施例而已,并不用以限制本實用新型,凡在本實用新型的精神和原則之內(nèi)所作的任何修改、等同替換和改進等,均應包含在本實用新型的保護范圍之內(nèi)。
【主權項】
1.一種軟關機控制電路,與機械手臂的驅動器連接,其特征在于,包括連接在電源端口和所述驅動器之間的開關模塊、與所述電源端口連接的電源按鍵及控制所述機械手臂運動和復位的控制器,所述控制器的檢測端口接所述電源按鍵,所述控制器的輸出端口接所述開關t吳塊; 其中,所述控制器檢測到所述電源按鍵斷開時,控制所述機械手臂復位后,再控制所述開關t吳塊關斷。2.如權利要求1所述的軟關機控制電路,其特征在于,還包括第一二極管,所述第一二極管的陽極接所述電源端口,陰極接所述電源按鍵的一端。3.如權利要求2所述的軟關機控制電路,其特征在于,所述電源端口、所述開關模塊及所述第一二極管均為多個,每個所述電源端口分別接入電壓,并分別通過所述第一二極管接到所述電源按鍵,還分別通過所述開關模塊接所述驅動器。4.如權利要求1所述的軟關機控制電路,其特征在于,還包括電源轉換模塊,所述電源轉換模塊接在所述電源按鍵和所述控制器的檢測端口之間。5.如權利要求4所述的軟關機控制電路,其特征在于,還包括指示燈,所述指示燈與所述電源轉換模塊的輸入端或輸出端連接。6.如權利要求4或5所述的軟關機控制電路,其特征在于,還包括第二二極管及限流電阻,所述第二二極管的陽極接所述電源轉換模塊的輸出端,所述第二二極管的陰極接所述開關模塊的控制端,且所述第二二極管的陰極通過所述限流電阻接所述控制器的輸出端□ O7.如權利要求1或3所述的軟關機控制電路,其特征在于,所述開關模塊包括第一匪OS管,所述第一NMOS管的漏極接所述電源端口,源極接所述機械手臂的驅動器,柵極接所述控制器的輸出端口。8.如權利要求1或3所述的軟關機控制電路,其特征在于,所述開關模塊包括第二匪OS管和第一PMOS管,所述第一PMOS管的源極接所述電源端口,漏極接所述機械手臂的驅動器,柵極接所述第二匪OS管的漏極,所述第二 NMOS管的源極接地,所述第二 NMOS管的柵極接控制器的輸出端口。9.如權利要求1所述的軟關機控制電路,其特征在于,所述控制器為單片機芯片或DSP芯片。10.—種機械臂裝置,包括多節(jié)機械手臂及驅動該機械手臂運動的驅動器,其特征在于,還包括權利要求1至9任一項所述的軟關機控制電路。
【文檔編號】G05B19/042GK205644180SQ201620465467
【公開日】2016年10月12日
【申請日】2016年5月19日
【發(fā)明人】劉培超
【申請人】深圳市越疆科技有限公司