CN105666492B - Scara机器人关节回零控制方法 - Google Patents
Scara机器人关节回零控制方法 Download PDFInfo
- Publication number
- CN105666492B CN105666492B CN201610140433.6A CN201610140433A CN105666492B CN 105666492 B CN105666492 B CN 105666492B CN 201610140433 A CN201610140433 A CN 201610140433A CN 105666492 B CN105666492 B CN 105666492B
- Authority
- CN
- China
- Prior art keywords
- joint
- zero
- joint motor
- scara
- robot
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 19
- 230000033001 locomotion Effects 0.000 claims description 14
- 238000012544 monitoring process Methods 0.000 claims description 12
- 238000001514 detection method Methods 0.000 claims description 4
- 230000000694 effects Effects 0.000 description 2
- GOLXNESZZPUPJE-UHFFFAOYSA-N spiromesifen Chemical compound CC1=CC(C)=CC(C)=C1C(C(O1)=O)=C(OC(=O)CC(C)(C)C)C11CCCC1 GOLXNESZZPUPJE-UHFFFAOYSA-N 0.000 description 2
- 230000005611 electricity Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/163—Programme controls characterised by the control loop learning, adaptive, model based, rule based expert control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J17/00—Joints
- B25J17/02—Wrist joints
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
本发明提供了一种SCARA机器人关节回零控制方法,包括步骤:(1)关节电机反转并检测零点;(2)当检测到零点位置时,关节电机继续反转;(3)关节电机正转并检测零点;(4)当检测到零点位置时,关节电机停止运转,完成回零过程。本发明的SCARA机器人关节回零控制方法,提高了回零的定位精度。同时采用位置传感器进行回零操作,避免机器人发生碰撞损坏。
Description
技术领域
本发明属于工业机器人技术领域,具体地说,本发明涉及一种SCARA机器人关节回零控制方法。
背景技术
随着工业机器人应用领域的不断扩展,工业机器人工作环境越来越复杂,面临的作业任务难度也越来越大。在工业机器人实际操作使用中,机器人上电后,需要进行回零操作,将机器人各个轴回到初始位置,亦可称为参考点或机械零点,是工业机器人制造者规定的机械原点,通常安装在各进给轴正方向的最大行程处。在某些情况下,要先执行机器回零的操作。
现有的SCARA(Selective Compliance Assembly Robot Arm,选择顺应性装配机器手臂)机器人,回零的方法是,碰到零点开关时,马上减速停止,以此停止点为机床零点。但回零方法容易受到接近开关响应精度、电源波动、回零进给速度等外部因素影响,机器回零误差可达丝级以上。
发明内容
本发明提供一种SCARA机器人关节回零控制方法,目的是提高回零定位精度。
为了解决上述技术问题,本发明所采用的技术方案是:SCARA机器人关节回零控制方法,包括步骤:
(1)关节电机反转并检测零点;
(2)当检测到零点位置时,关节电机继续反转;
(3)关节电机正转并检测零点;
(4)当检测到零点位置时,关节电机停止运转,完成回零过程。
所述关节电机在步骤(2)时的转速小于在步骤(1)时的转速。
所述关节电机在步骤(3)时的转速小于在步骤(1)时的转速。
所述关节电机在步骤(2)中反转时的转动量不应使关节运动超过极限位置。
在回零过程中,SCARA机器人的状态监控模块通过检测设置于机器人本体上的位置传感器信息来确定是否回到零点。
机器人本体上设有位置传感器,SCARA机器人的状态监控模块定时读取位置传感器信息,当关节运动超出允许范围时,状态监控模块调用运动控制模块,控制关节电机停止运动。
本发明的SCARA机器人关节回零控制方法,提高了回零的定位精度。同时采用位置传感器进行回零操作,避免机器人发生碰撞损坏。
附图说明
图1为本发明SCARA机器人关节回零控制方法的流程图;
具体实施方式
下面对照附图,通过对实施例的描述,对本发明的具体实施方式作进一步详细的说明,目的是帮助本领域的技术人员对本发明的构思、技术方案有更完整、准确和深入的理解,并有助于其实施。
如图1所示,本发明提供了一种SCARA机器人关节回零控制方法,其包括如下步骤:
(1)关节电机反转并检测零点;
(2)当检测到零点位置时,关节电机继续反转;
(3)关节电机正转并检测零点;
(4)当检测到零点位置时,关节电机停止运转,完成回零过程。
具体地说,根据系统的控制功能要求,SCARA机器人有以下关节运动控制指令:关节正转、关节反转,关节正转一定角度(或距离),关节反转一定角度(或距离)、停止转动、速度设置、回零、伺服ON(或OFF)、禁止(或允许)关节正转、禁止(或允许)关节反转。其中,关节正转或反转一定转动量指令和回零指令不仅要给出控制指令,而且还要给定转动量数据。
如图1所示,在步骤(1)中,关节电机快速反转,寻找零点位置。直至检测到零点位置后,进行下一步骤。在步骤(2)中,当检测到零点位置时,就将关节电机速度设置为慢速继续反转一定距离,这段距离不应使关节运动超过极限位置,即关节电机在步骤(2)中反转时的转动量不应使关节运动超过极限位置。
如图1所示,在步骤(3)中,关节电机由反转变为正转,关节电机慢速正转,并寻找零点位置。当检测到零点位置时,立即给出电机停止信号,关节电机停止运转,从而实现关节的回零运动。
到步骤(3)时,因为已经检测到达终点了(零点位置),而且关节电机如果继续反转的话会超出终点的部分行程外,那么这是不允许的,这时需要反转回来,变为正转,继续回到终点(零点位置)。这样做的目的是由于单独的一次定位会产生误判,精度低,而关节电机先反转一次检测零点后再正转一次检测零点,得到的效果要好,精度控制准。
为防止SCARA机器人的各关节运动超出允许范围而造成机械碰撞,需在机器人本体上安装有多个位置传感器,位置传感器在机器人本体上的安装位置是处于可进行运动的关节的极限行程位置处,此处位置传感器的目的是防止运动关节停不下来继续行走,因为就算到了零点位置,还不是关节的极限位置。位置传感器的位置才是运动关节的终点位置,绝对不能过。SCARA机器人具有状态监控模块和运动控制模块,状态监控模块就是监控机器正在运行的位置状态,运动控制模块就是使机器正反转运行的控制模块,一个起监控观察作用,一个起控制运行作用。SCARA机器人的状态监控模块定时读取这些位置传感器信息,当某关节运动超出允许范围时,状态监控模块就会调用SCARA机器人的运动控制模块,运动控制模块控制该关节电机停止运动,从而实现超程防止功能。在回零过程中,状态监控模块通过检测位置传感器信息来确定是否回到零点。
上面结合附图对本发明进行了示例性描述,显然本发明具体实现并不受上述方式的限制,只要采用了本发明的方法构思和技术方案进行的各种非实质性的改进,或未经改进将本发明的构思和技术方案直接应用于其它场合的,均在本发明的保护范围之内。
Claims (3)
1.SCARA机器人关节回零控制方法,其特征在于,包括步骤:
(1)关节电机反转并检测零点;
(2)当检测到零点位置时,关节电机继续反转;
(3)关节电机正转并检测零点;
(4)当检测到零点位置时,关节电机停止运转,完成回零过程;
所述关节电机在步骤(2)时的转速小于在步骤(1)时的转速,所述关节电机在步骤(2)中反转时的转动量不应使关节运动超过极限位置,所述关节电机在步骤(3)时的转速小于在步骤(1)时的转速。
2.根据权利要求1所述的SCARA机器人关节回零控制方法,其特征在于,在回零过程中,SCARA机器人的状态监控模块通过检测设置于机器人本体上的位置传感器信息来确定是否回到零点。
3.根据权利要求1所述的SCARA机器人关节回零控制方法,其特征在于,机器人本体上设有位置传感器,SCARA机器人的状态监控模块定时读取位置传感器信息,当关节运动超出允许范围时,状态监控模块调用运动控制模块,控制关节电机停止运动。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610140433.6A CN105666492B (zh) | 2016-03-11 | 2016-03-11 | Scara机器人关节回零控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610140433.6A CN105666492B (zh) | 2016-03-11 | 2016-03-11 | Scara机器人关节回零控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105666492A CN105666492A (zh) | 2016-06-15 |
CN105666492B true CN105666492B (zh) | 2018-02-16 |
Family
ID=56308245
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610140433.6A Active CN105666492B (zh) | 2016-03-11 | 2016-03-11 | Scara机器人关节回零控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105666492B (zh) |
Families Citing this family (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106788010B (zh) * | 2016-11-28 | 2018-12-21 | 湖南明和光电设备有限公司 | 步进电机运动系统自检回零的方法 |
CN106774149B (zh) * | 2016-11-30 | 2019-03-26 | 上海新时达电气股份有限公司 | 工业机器人的调零方法及系统 |
CN107443381B (zh) * | 2017-09-05 | 2020-08-04 | 中科新松有限公司 | 一种弹性驱动关节的力矩寻零方法 |
CN109849046B (zh) * | 2017-11-30 | 2020-11-24 | 深圳市优必选科技有限公司 | 一种舵机转子的回零方法、回零系统、舵机及机器人 |
CN110316547B (zh) * | 2018-03-31 | 2021-04-06 | 浙江大学常州工业技术研究院 | 核工业转运装置的快速回零方法 |
CN108536177A (zh) * | 2018-04-03 | 2018-09-14 | 北京爱科迪通信技术股份有限公司 | 一种用于提高位置控制系统中限位精度的方法 |
CN108568839B (zh) * | 2018-06-06 | 2023-09-26 | 华南理工大学 | 一种用于scara圆柱副关节的回零装置及其方法 |
CN108582081A (zh) * | 2018-07-04 | 2018-09-28 | 北京镁伽机器人科技有限公司 | 具有回零位功能的机器人、回零位方法、系统和介质 |
CN108582082A (zh) * | 2018-07-04 | 2018-09-28 | 北京镁伽机器人科技有限公司 | 具有精确回零位功能的机器人、回零位方法、系统和介质 |
CN109623851B (zh) * | 2019-01-09 | 2021-02-09 | 北京精密机电控制设备研究所 | 一种机械臂关节零位装置和回零方法 |
CN109605344B (zh) * | 2019-01-09 | 2021-02-09 | 北京精密机电控制设备研究所 | 一种多自由度开环步进串联机械臂及其控制方法 |
CN109866223B (zh) * | 2019-03-07 | 2021-11-09 | 济南翼菲自动化科技有限公司 | Delta机器人扭矩找零点方法 |
CN110865560A (zh) * | 2019-11-06 | 2020-03-06 | 泰德激光惠州有限公司 | 回零运动控制方法、终端设备及计算机可读存储介质 |
CN111805534A (zh) * | 2020-06-02 | 2020-10-23 | 珠海格力智能装备有限公司 | 一种机器人及其零点标定的方法 |
CN112518749A (zh) * | 2020-11-30 | 2021-03-19 | 国网浙江省电力有限公司宁波供电公司 | 一种电力巡检机器人机械臂 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0272614A2 (de) * | 1986-12-22 | 1988-06-29 | Behr Industrieanlagen GmbH & Co. | Einrichtung zum Referenzieren eines Roboters |
CN102717395A (zh) * | 2011-03-30 | 2012-10-10 | 北京理工大学 | 基于霍尔开关的机器人关节初始位置精确定位系统 |
CN102837309A (zh) * | 2011-06-22 | 2012-12-26 | 北京理工大学 | 机器人360度旋转关节的防绕线定位装置 |
CN103240743A (zh) * | 2013-05-14 | 2013-08-14 | 中国科学院自动化研究所 | 一种用于增量式码盘性能的提高系统及其方法 |
CN103395073A (zh) * | 2013-08-22 | 2013-11-20 | 中国船舶重工集团公司第七一六研究所 | 一种六轴工业机器人的零点标定方法 |
-
2016
- 2016-03-11 CN CN201610140433.6A patent/CN105666492B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0272614A2 (de) * | 1986-12-22 | 1988-06-29 | Behr Industrieanlagen GmbH & Co. | Einrichtung zum Referenzieren eines Roboters |
CN102717395A (zh) * | 2011-03-30 | 2012-10-10 | 北京理工大学 | 基于霍尔开关的机器人关节初始位置精确定位系统 |
CN102837309A (zh) * | 2011-06-22 | 2012-12-26 | 北京理工大学 | 机器人360度旋转关节的防绕线定位装置 |
CN103240743A (zh) * | 2013-05-14 | 2013-08-14 | 中国科学院自动化研究所 | 一种用于增量式码盘性能的提高系统及其方法 |
CN103395073A (zh) * | 2013-08-22 | 2013-11-20 | 中国船舶重工集团公司第七一六研究所 | 一种六轴工业机器人的零点标定方法 |
Non-Patent Citations (1)
Title |
---|
SR机器人控制系统的研制;曾斌;《中国硕士学位论文全文数据库(电子期刊)信息科技辑》;20041215(第4期);正文第51-52页 * |
Also Published As
Publication number | Publication date |
---|---|
CN105666492A (zh) | 2016-06-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105666492B (zh) | Scara机器人关节回零控制方法 | |
CN102183916B (zh) | 有限转角伺服转台用位置寻零方法 | |
CN104698974B (zh) | 一种数控机床及其调试方法 | |
CN104914864A (zh) | 一种移动装置、移动装置控制系统及控制方法 | |
CN103955231B (zh) | 多关节机械臂智能控制方法、装置及系统 | |
WO2021088235A1 (zh) | 零点定位方法、系统、伺服电机及存储介质 | |
CN111923038B (zh) | 机械臂式机器人、机器人的避障方法及存储介质 | |
CN104057456A (zh) | 机器人拾取系统及被加工物的制造方法 | |
CN109623851B (zh) | 一种机械臂关节零位装置和回零方法 | |
CN102608351B (zh) | 机械臂三维姿态的检测方法和系统、及控制其运行的系统 | |
CN109483529A (zh) | 一种基于螺旋理论的机械臂伺服控制方法、系统及装置 | |
JP2010228028A (ja) | ロボットアーム、ロボットアームの接触検知方法、及び、ロボットアームを備えた装置 | |
CN102621991A (zh) | 运动机构的定位控制装置、系统、方法和工程机械 | |
CN110103201B (zh) | 作业机器人系统 | |
CN109746936B (zh) | 机器人的关节限位方法、装置、系统及存储介质 | |
CN102003955A (zh) | 基于图像分析的位置检测传感装置及其位置检测方法 | |
CN110116424B (zh) | 机器人 | |
CN105403190A (zh) | 一种步进电机位移检测系统 | |
CN102818557A (zh) | 位姿自动测量装置和工程机械 | |
CN116494250B (zh) | 基于速度补偿的机械臂控制方法、控制器、介质及系统 | |
CN114834300A (zh) | 托盘伸出定位方法和系统 | |
CN105676781B (zh) | 基于Petri网的数控机床控制系统故障诊断方法 | |
CN106299695A (zh) | 通信天线自动定向装置 | |
CN114753072A (zh) | 一种刺绣机绣框断电保护控制方法、系统及装置 | |
CN111699078A (zh) | 机器人的运行 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |