CN106965170A - 以反电动势为监控依据的夹持装置及控制方法 - Google Patents

以反电动势为监控依据的夹持装置及控制方法 Download PDF

Info

Publication number
CN106965170A
CN106965170A CN201610022694.8A CN201610022694A CN106965170A CN 106965170 A CN106965170 A CN 106965170A CN 201610022694 A CN201610022694 A CN 201610022694A CN 106965170 A CN106965170 A CN 106965170A
Authority
CN
China
Prior art keywords
electromotive force
counter electromotive
control
stepper motor
clamping device
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN201610022694.8A
Other languages
English (en)
Other versions
CN106965170B (zh
Inventor
翁振民
陈惟绍
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Hiwin Technologies Corp
Original Assignee
Hiwin Technologies Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Hiwin Technologies Corp filed Critical Hiwin Technologies Corp
Priority to CN201610022694.8A priority Critical patent/CN106965170B/zh
Priority to JP2016014383A priority patent/JP6596345B2/ja
Priority to US15/046,169 priority patent/US20170232610A1/en
Publication of CN106965170A publication Critical patent/CN106965170A/zh
Application granted granted Critical
Publication of CN106965170B publication Critical patent/CN106965170B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • HELECTRICITY
    • H02GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02PCONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P8/00Arrangements for controlling dynamo-electric motors rotating step by step
    • H02P8/34Monitoring operation
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1612Programme controls characterised by the hand, wrist, grip control
    • HELECTRICITY
    • H02GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02PCONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P6/00Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
    • H02P6/14Electronic commutators
    • H02P6/16Circuit arrangements for detecting position
    • H02P6/18Circuit arrangements for detecting position without separate position detecting elements
    • H02P6/182Circuit arrangements for detecting position without separate position detecting elements using back-emf in windings
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/37Measurements
    • G05B2219/37023Step motor used as measuring device and as drive motor
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/39Robotics, robotics to robotics hand
    • G05B2219/39514Stability of grasped objects
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/42Servomotor, servo controller kind till VSS
    • G05B2219/42304Load, torque threshold as function of speed

Landscapes

  • Engineering & Computer Science (AREA)
  • Power Engineering (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • General Health & Medical Sciences (AREA)
  • Orthopedic Medicine & Surgery (AREA)
  • Health & Medical Sciences (AREA)
  • Control Of Stepping Motors (AREA)
  • Manipulator (AREA)
  • General Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)

Abstract

本发明提供一种以反电动势为监控依据的夹持装置及控制方法,主要是通过实时监控于正常运作状态下所事先量测制成的控制参数矩阵与实际反电动势值,据以在异常发生前都能稳定的夹持,确保夹持工作都能在正常状况下运作,提高夹持稳定性。

Description

以反电动势为监控依据的夹持装置及控制方法
技术领域
本发明涉及机械手领域,特别是涉及一种以反电动势为监控依据的夹持装置及控制方法。
背景技术
随着自动化生产于各领域的广泛利用,具有体积小、重量轻、外型逼真及灵活度高特点的电动夹爪的重要性与日俱增,为确保夹持工作的稳定性,电动夹爪就必须在夹持工作进行中被实时监测或控制。
而监测或控制电动夹爪的方式众多,已知其中一种控制方式是依据步进马达的特性进行控制控制,其控制基础在于步进马达具有输出转矩与转速成反比的特性,通过控制切换步进马达的速度来控制由步进马达驱动的夹爪的夹持力;然而,此种控制方式仍会产生运作中不乐见的缺陷,由于步进马达的输出转矩与转速成反比,因此在步进马达速度急遽变化,例如急遽加速时,此时,转矩下降而无法负荷外界负载,而造成小幅度的滑脱,造成失步,而此失步现象将影响夹持的稳定性而有被改善的必要;
另有一种已知的控制方式则是另外设置传感器侦测马达失步,当马达失步时即切断马达的电源,改以另外的保持机构保持夹持力;而此种控制方式是在马达失步时才做保持夹持力的应对手段,因此完全无法避免马达失步的状况发生,因此夹持力量无法被稳定的控制;况且,这种控制方式还必须配置独立的保持机构保持夹持力,因此将会使整体机构复杂化并提高整体机构成本,并因此提高制造端成本上的负担而有待改善;
有鉴于此,本发明人潜心研究并更深入构思,历经多次研发试作后,终于发明出一种以反电动势为监控依据的夹持装置及控制方法。
发明内容
本发明提供一种以反电动势为监控依据的夹持装置及控制方法,其主要目的是改善一般夹爪控制方式仍有夹持力无法稳定控制、机构复杂的缺陷。
为达前述目的,本发明提供一种以反电动势为监控依据的夹持装置,包含:
夹持装置;
步进马达,链接夹持装置并可驱动夹持装置夹持或松释;
控制器,与步进马达电性连接,且控制器包含电性连接的驱动单元、控制单元、指令接收单元以及存取单元,其中:
驱动单元电性连接步进马达而能驱动步进马达运转并回馈步进马达的实际反电动势值;
控制单元与驱动单元电性连接;
指令接收单元与控制单元电性连接,且指令接收单元能接受对夹持装置的夹持状态、夹持速度及夹持力的控制指令;以及
存取单元与控制单元电性连接,且存取单元内存置控制参数矩阵,控制参数矩阵中的每一位置具有对应的反电动势阀值;控制单元能依据指令接收单元的控制指令控制步进马达运作,且控制单元更能以控制指令比对控制参数矩阵取得对应的反电动势阀值并实时比对实际反电动势值,最后依据比对结果选择控制步进马达。
同样为达前述目的,本发明更提供一种以反电动势为监控依据的夹持装置控制方法,包含依序进行:
驱动步进马达步骤,控制器依照控制指令通过驱动单元驱动步进马达运转,且步进马达运转时产生实际反电动势值;
比对控制参数矩阵步骤,控制器依据控制指令比对存取单元中的控制参数矩阵,控制参数矩阵中的每一位置具有对应的反电动势阀值;
求对应反电动势阀值步骤,控制器比对实际反电动势于控制参数矩阵的位置以求得对应的反电动势阀值;
监控实际反电动势步骤,控制器持续监控实际反电动势值;
比对并控制步骤,控制器比对监控的实际反电动势值及求得的反电动势阀值,当实际反电动势值小于反电动势阀值时,维持步进马达的驱动;而当实际反电动势值达反电动势阀值时,停止继续驱动步进马达以维持夹持。
本发明通过实时监控于正常运作状态下所事先量测制成的控制参数矩阵与与实际反电动势值,据以在异常发生前进行稳定的夹持,并确保夹持工作都能在正常状况下运作,提高夹持稳定性。
附图说明
图1为本发明的以反电动势为监控依据的夹持装置的系统配置图。
图2为本发明的以反电动势为监控依据的夹持装置控制方法的步骤流程图。
图3为本发明的以中控制参数矩阵的示意图。
附图中符号标记说明:
10为夹持装置;20为步进马达;30为控制器;31为驱动单元;32为控制单元;33为指令接收单元;34为存取单元;(I)为接收控制指令步骤;(II)为驱动步进马达步骤;(III)为比对控制参数矩阵步骤;(IV)为求对应反电动势阀值步骤;(V)为监控实际反电动势步骤;(VI)为比对并控制步骤。
具体实施方式
下面将结合附图对本发明的技术方案进行清楚、完整的描述,显然,所描述的实施例是本发明的一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动的前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明实施例提供一种以反电动势为监控依据的夹持装置,请配合参阅图1至图3所示,包含:
夹持装置10;
步进马达20,链接夹持装置10并可驱动夹持装置10夹持或松释;
控制器30,与步进马达20电性连接,且控制器30包含电性连接的驱动单元31、控制单元32、指令接收单元33以及存取单元34,其中:
驱动单元31电性连接步进马达20而能驱动步进马达20运转并回馈步进马达20的实际反电动势值;
控制单元32与驱动单元31电性连接;
指令接收单元33与控制单元32电性连接,且指令接收单元33能接受对夹持装置10的夹持状态、夹持速度及夹持力的控制指令;以及
存取单元34与控制单元32电性连接,且存取单元34内存置控制参数矩阵,控制参数矩阵为以夹持装置的夹持状态(夹持、松释)、夹持速度及夹持力为参数制成的三维矩阵,且于控制参数矩阵中的每一位置均有对应的反电动势阀值,且上述参数均为在步进马达正常运作无失步的状态下实际量测;控制单元32能依据指令接收单元33的控制指令控制步进马达20运作,且控制单元30更能以控制指令比对控制参数矩阵取得对应的反电动势阀值并实时比对实际反电动势值,最后依据比对结果选择控制步进马达20。
以上为本发明以反电动势为监控依据的夹持装置的结构组态及特征,而其控制方法依序包含:
接收控制指令步骤(I),通过指令接收单元33下达控制指令,指令接收单元接收对夹持装置10的夹持状态、夹持速度及夹持力的控制指令;
驱动步进马达步骤(II),控制器30的指令接收单元33接收控制指令后,控制单元32存取并依据指令接收单元32所接收的控制指令驱动步进马达20运转,且步进马达20运转时产生实际反电动势值;
比对控制参数矩阵步骤(III),控制器30的控制单元32依据指令接收单元32所接收的控制指令的参数比对存取单元34中的控制参数矩阵,控制参数矩阵中的每一位置具有对应的反电动势阀值;
求对应反电动势阀值步骤(IV),控制器30比对实际反电动势于控制参数矩阵的位置以求得对应的反电动势阀值;进一步地,请配合参阅如图3所示为控制参数矩阵的示意图,控制参数矩阵是由夹持装置10的夹持状态、夹持速度以及夹持力建立的三维矩阵,当然,控制参数矩阵中各维度中的元素可依控制需求改变,而以此例来说,用第一维度表示夹持状态,夹持状态具有2个元素分别代表夹掣(1)与松释(0);用第二维度表示夹持速度,其具有20个元素,代表1mm/s到20mm/s;用第三维度代表夹持力,其具有11个元素,代表50%到100%的力量。当控制器30由指令接收单元33接收外部的控制指令后,控制单元32即会存取存取单元34中的控制参数矩阵并求得对应的反电动势阀值;例如,当外部命令为“松释、5mm/s、50%”时,控制单元32会对应参数值并寻址到[0][4][0]的矩阵位置读取该位置的反电动势阀值;
监控实际反电动势步骤(V),控制器30的控制单元32持续监控由驱动单元31反馈的实际反电动势值;
比对并控制步骤(VI),控制器30的控制单元32比对监控的实际反电动势值及求得的反电动势阀值,当实际反电动势值小于反电动势阀值时,维持步进马达的驱动;而当实际反电动势值达反电动势阀值时,代表夹持装置10已夹持到对象,则停止继续驱动该步进马达20,使夹持装置10维持于此夹持状态。
综上,本发明实施例主要通过事先量测非失步状态时的运作参数并制成控制参数矩阵,并在控制夹持装置10夹持时实时回馈实际反电动势值、实时比对控制参数矩阵,据此而能在比对后实时依据比对结果进行监控,达到实时监控、稳定夹持参数的目的;
而由于本发明实施例是以反电动势值做为实时监控的基础,配合本发明实施例中控制参数矩阵的参考,因此本发明实施例能确实防止失步现象的发生,确保每个夹持动作保持在最佳夹持状态,提高夹持力的稳定性,并能完全避免发生工件松脱的状况发生,提高产品良率。
此外,由于本发明实施例是通过监控步进马达20运作产生的反电动势值,整个监控过程中不需独立设置扭力传感器,因此又具有结构组态简单、装配使用自由度高的优异性,当然也据此提高整体产品的附加价值。
还有,由于本发明实施例的控制参数矩阵是结合夹持状态、夹持速度以及夹持力制成的三维矩阵,如此意谓本发明实施例能在不同的夹持状态、不同的夹持速度以及不同的夹持力条件下均能得到相应的反电动势阀值,因此又显示本发明实施例的运用具有极佳的动态性,适用度高,而具有极高的经济价值;基于此,又可进一步推论,当夹持装置的控制参数不同时,控制参数矩阵的参数值是能被增减及改变的,控制参数矩阵并不限于如图3的参数才是。
综上所述,上述各实施例及附图仅为本发明的较佳实施例而已,并不用以限定本发明的保护范围,凡在本发明的精神和原则之内,所做的任何修改、等同替换、改进等,皆应包含在本发明的保护范围内。

Claims (4)

1.一种以反电动势为监控依据的夹持装置,其特征在于,包含:
夹持装置;
步进马达,链接所述夹持装置并可驱动所述夹持装置夹持或松释;
控制器,与所述步进马达电性连接,且所述控制器包含电性连接的驱动单元、控制单元、指令接收单元以及存取单元,其中:
所述驱动单元电性连接所述步进马达而能驱动所述步进马达运转并回馈所述步进马达的实际反电动势值;
所述控制单元与所述驱动单元电性连接;
所述指令接收单元与所述控制单元电性连接,且所述指令接收单元能接受对夹持装置的夹持状态、夹持速度及夹持力的控制指令;以及
所述存取单元与所述控制单元电性连接,且所述存取单元内存置控制参数矩阵,所述控制参数矩阵中的每一位置具有对应的反电动势阀值;所述控制单元能依据所述指令接收单元的控制指令控制所述步进马达运作,且所述控制单元更能以所述控制指令比对所述控制参数矩阵取得对应的反电动势阀值并实时比对所述实际反电动势值,最后依据比对结果选择控制所述步进马达。
2.根据权利要求1所述的以反电动势为监控依据的夹持装置,其中其特征在于,所述控制参数矩阵为以夹持装置的夹持状态(夹持、松释)、夹持速度及夹持力为参数制成的三维矩阵。
3.一种以反电动势为监控依据的夹持装置控制方法,其特征在于,所述控制方法包含依序进行:
驱动步进马达步骤,控制器依照控制指令通过驱动单元驱动步进马达运转,且所述步进马达运转时产生实际反电动势值;
比对控制参数矩阵步骤,所述控制器依据所述控制指令比对存取单元中的控制参数矩阵,所述控制参数矩阵中的每一位置具有对应的反电动势阀值;
求对应反电动势阀值步骤,所述控制器比对实际反电动势于所述控制参数矩阵的位置以求得对应的反电动势阀值;
监控实际反电动势步骤,所述控制器持续监控实际反电动势值;
比对并控制步骤,所述控制器比对监控的实际反电动势值及求得的反电动势阀值,当实际反电动势值小于反电动势阀值时,维持步进马达的驱动;而当实际反电动势值达反电动势阀值时,停止继续驱动步进马达以维持夹持。
4.根据权利要求3所述的以反电动势为监控依据的夹持装置控制方法,其特征在于,所述控制参数矩阵为以夹持装置的夹持状态(夹持、松释)、夹持速度及夹持力为参数制成的三维矩阵。
CN201610022694.8A 2016-01-14 2016-01-14 以反电动势为监控依据的夹持装置及控制方法 Active CN106965170B (zh)

Priority Applications (3)

Application Number Priority Date Filing Date Title
CN201610022694.8A CN106965170B (zh) 2016-01-14 2016-01-14 以反电动势为监控依据的夹持装置及控制方法
JP2016014383A JP6596345B2 (ja) 2016-01-14 2016-01-28 逆起電力をモニターの根拠とする挟み装置とその制御方法
US15/046,169 US20170232610A1 (en) 2016-01-14 2016-02-17 Gripping device which is monitored based on counter electromotive force and a method for controlling the gripping device

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
CN201610022694.8A CN106965170B (zh) 2016-01-14 2016-01-14 以反电动势为监控依据的夹持装置及控制方法
JP2016014383A JP6596345B2 (ja) 2016-01-14 2016-01-28 逆起電力をモニターの根拠とする挟み装置とその制御方法
US15/046,169 US20170232610A1 (en) 2016-01-14 2016-02-17 Gripping device which is monitored based on counter electromotive force and a method for controlling the gripping device

Publications (2)

Publication Number Publication Date
CN106965170A true CN106965170A (zh) 2017-07-21
CN106965170B CN106965170B (zh) 2019-12-03

Family

ID=69063569

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610022694.8A Active CN106965170B (zh) 2016-01-14 2016-01-14 以反电动势为监控依据的夹持装置及控制方法

Country Status (3)

Country Link
US (1) US20170232610A1 (zh)
JP (1) JP6596345B2 (zh)
CN (1) CN106965170B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TWI663031B (zh) * 2017-12-13 2019-06-21 上銀科技股份有限公司 適應性夾持的控制方法及電動夾爪

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6463835B1 (en) * 1998-10-23 2002-10-15 Hitachi Seiki Co., Ltd. Method and apparatus for controlling motor-driven chucking device
US20090243526A1 (en) * 2008-03-25 2009-10-01 Daisuke Ito Device and method for detecting back electromotive force phase and device and method for controlling excitation
US20120239197A1 (en) * 2010-12-13 2012-09-20 Ganz Brian L Robotic gripper

Family Cites Families (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0735740Y2 (ja) * 1986-03-05 1995-08-16 株式会社島津製作所 ロボツトハンド
JPH05318372A (ja) * 1992-05-14 1993-12-03 Canon Inc ワーク把持装置
JP3653209B2 (ja) * 2000-05-10 2005-05-25 矢崎総業株式会社 ステッパモータ駆動回路及びステッパモータ駆動回路に用いられる初期設定方法
JP2009045687A (ja) * 2007-08-20 2009-03-05 Ntn Corp 把持装置の把持制御装置
JP2010069585A (ja) * 2008-09-19 2010-04-02 Yaskawa Electric Corp 衝突検出装置及び方法並びにロボット制御装置
JP5973786B2 (ja) * 2012-05-25 2016-08-23 ナブテスコ株式会社 産業用ロボットの集中監視装置、集中監視プログラムおよびメンテナンスシステム
JP2014046449A (ja) * 2012-09-04 2014-03-17 Canon Inc ロボットハンド制御方法、ロボットハンド制御装置及びロボット装置
JP5866034B2 (ja) * 2013-01-31 2016-02-17 三菱電機株式会社 電動機駆動装置
JP6100561B2 (ja) * 2013-02-28 2017-03-22 ローム株式会社 モータ駆動回路、およびその駆動方法、それを用いた電子機器

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6463835B1 (en) * 1998-10-23 2002-10-15 Hitachi Seiki Co., Ltd. Method and apparatus for controlling motor-driven chucking device
US20090243526A1 (en) * 2008-03-25 2009-10-01 Daisuke Ito Device and method for detecting back electromotive force phase and device and method for controlling excitation
US20120239197A1 (en) * 2010-12-13 2012-09-20 Ganz Brian L Robotic gripper

Also Published As

Publication number Publication date
CN106965170B (zh) 2019-12-03
US20170232610A1 (en) 2017-08-17
JP6596345B2 (ja) 2019-10-23
JP2017132004A (ja) 2017-08-03

Similar Documents

Publication Publication Date Title
CN206908538U (zh) 伺服电机驱动装置和系统
CN104362910A (zh) 基于直流无刷电动工具的恒功率双速控制系统及控制方法
CN202878325U (zh) 小型模块化机械手臂
CN105022269B (zh) 仿生机器鱼关节的控制方法及装置
CN101340165A (zh) 多电机同步控制系统
CN106271573A (zh) 一种双工位螺钉自动化装配设备
CN106965170A (zh) 以反电动势为监控依据的夹持装置及控制方法
CN206135675U (zh) 一种数字舵机
CN101132159A (zh) 无刷电动机控制器
CN103480885A (zh) 一种多工位钻攻丝机床控制系统及其控制方法
CN206741309U (zh) 一种两轮自平衡小车
CN202710579U (zh) 一种样品盘自动化上样定位控制系统
CN205325690U (zh) 不用减速机的机器人多关节传动结构
CN203159905U (zh) 刺绣机换色控制系统
CN200976557Y (zh) 无刷电动机控制器
CN201660093U (zh) 一种电动助力自行车助力自动修正系统
CN111090972A (zh) 一种使用MATLAB软件绘制电机效率map图的方法
CN212291883U (zh) 一种具有夹持功能的机器人
CN108656090A (zh) 一种机械手组件及控制该机械手组件的控制单元
CN203528946U (zh) 包膜机的切刀机构
CN101510746B (zh) 基于直流电机速度控制的控制对象参数识别方法
CN203708021U (zh) 汽车仪表中步进电机自动装配系统
CN202735721U (zh) 机器人运动控制集成系统
CN206039223U (zh) 基于单片机的多尺寸移动式切割机
CN202789374U (zh) 一种注射泵

Legal Events

Date Code Title Description
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant