CN101973035B - 机器人关节初始位置精确定位方法及装置 - Google Patents
机器人关节初始位置精确定位方法及装置 Download PDFInfo
- Publication number
- CN101973035B CN101973035B CN2010105405190A CN201010540519A CN101973035B CN 101973035 B CN101973035 B CN 101973035B CN 2010105405190 A CN2010105405190 A CN 2010105405190A CN 201010540519 A CN201010540519 A CN 201010540519A CN 101973035 B CN101973035 B CN 101973035B
- Authority
- CN
- China
- Prior art keywords
- joint
- robot
- travel switch
- release conditions
- initial position
- 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.)
- Expired - Fee Related
Links
Images
Landscapes
- Manipulator (AREA)
Abstract
本发明涉及一种机器人关节初始位置精确定位方法及装置,按照如下步骤进行操作:机器人在上电工作时,中央控制***向各个关节控制器发出找零指令;各个关节控制器判断行程开关的闭合或释放状态,以确定关节旋转方向;根据确定的关节旋转方向,各个关节开始慢速旋转寻找事先确定的霍尔目标信号;找到目标霍尔信号后,开始捕捉电机轴Z脉冲信号;捕捉到Z脉冲信号的同时,关节停止转动,此时的位置是唯一的,记录当前位置,从而确定机器人的初始位置。与现有技术相比,本发明实现了机器人初始位置精确定位的自动化,具有成本低、结构简单、操作容易、精度高的优点。
Description
技术领域
本发明涉及一种机器人关节初始位置精确定位方法,以及实现该方法的装置。
背景技术
机器人一般由多个关节通过组合实现各种运动功能,其初始位置是指机器人工作或运动前各运动关节的初始位置,机器人所有运动都是相对于该初始位置,因此,初始位置的确定是机器人工作或运动的一个前提条件,所以,在机器人正常工作之前,必须采用一定的方法来精确确定其初始位置。
现有技术中,机器人关节初始位置定位方法常见的有三种:
(1)利用绝对式编码器确定。绝对式编码器一般安装在机器人关节处,对于每一个角度编码器会产生唯一的输出量,这样可以根据其输出数据信息来获取机器人关节的绝对位置。这种方法精度高,易操作,但是绝对式编码器一般体积较大,价格昂贵,其输出信号复杂,接线多,会使机构复杂化,同时还需用复杂的接口电路才能实现对其输出数据信息的读取。
(2)采用机械限位传感器确定。当关节运动到预定初始位置的时候触发限位开关,由此信号来确定初始零位。这种方法原理简单,但是定位精度最差,而且自动化程度不高,初始位置会受到不确定因素的影响而不唯一。
(3)利用霍尔传感器或光电传感器来确定,在机器人关节运动范围内按照一定规律布置两个以上的上述传感器,这些传感器的位置经过测量并记录在机器人控制***中,机器人上电时,首先驱动关节按照一定方向旋转,当关节旋转至上述传感器位置时,读取存储在机器人控制***中的该开关对应的关节位置值,这样可以确定该关节的初始位置。此方法定位精度较高,但是必须用到多个传感器,否则无法判断电机最初转动方向,会导致电机转动方向相反而无法找到准确的位置传感器;为了增加可靠性一般要在两个极限位置设置传感器,增加了***的复杂性;同时,如果不针对传感器的回差进行补偿,将无法消除传感器回差的影响,降低零位的定位精度。
发明内容
针对现有技术中的上述技术问题,本发明的目的在于提供一种低成本、易安装、定位精度高的机器人关节初始定位方法。
本发明通过如下的技术方案实现。
一种机器人关节初始定位方法,包括以下步骤:
(1)机器人在上电工作时,中央控制***向各个关节控制器发出找零指令;
(2)各个关节控制器判断行程开关的闭合或释放状态,以确定关节旋转方向;
(3)根据确定的关节旋转方向,各个关节开始慢速旋转寻找事先确定的霍尔目标信号;
(4)找到目标霍尔信号后,开始捕捉电机轴Z脉冲信号;
(5)捕捉到Z脉冲信号的同时,关节停止转动,此时的位置是唯一的,记录当前位置,从而确定机器人的初始位置。
与现有技术相比,本发明实现了机器人初始位置精确定位的自动化,具有成本低、结构简单、操作容易、精度高的优点。
附图说明
图1a、1b、1c是本发明的定位方法结构示意图,
图2是本发明定位方法的定位流程图。
其中各附图标记含义如下:
1-相对固定关节,2-行程开关,3-行程挡片,4-转动电机组件(增量式编码器、电机、减速机),5-转动关节,6-磁珠,7-霍尔传感器,8-行程开关释放位置,9-行程开关闭合位置。
具体实施方式
图1a-1c为定位结构示意图,1为相对固定关节,5为转动关节,当磁珠6(固定于旋转关节5上)与霍尔传感器7(固定于相对固定关节1上)重合时会捕捉到霍尔信号和电机Z脉冲信号,这一个唯一位置就是关节的初始零位置。由于霍尔传感器在上电前相对于旋转关节所处的初始位置是随机的,共有三个位置,图1-(a)为磁珠6左侧,图1-(b)为零位位置,图1-(c)为磁珠6右侧,因此,在关节找零位时,旋转关节可能会沿着逆时针(图1-(a))或者顺时针(图1-(c))两个不同方向旋转,所以在执行零位寻找,关节旋转前必须明确磁珠6与霍尔传感器7的相对位置,以便确定旋转关节的旋转方向,为此,加一行程开关2和行程挡片3(两者可以根据零位位置任意位置安装)来实现旋转方向的确定,例如:
图1a,行程挡片3压下行程开关2,使其处于闭合状态,如果外部接一状态检测电路,其闭合状态会被检测到并送至旋转关节5运动控制器,经过相应处理,此时,旋转关节5会逆时针旋转,以便能够保证磁珠6与霍尔传感器7的位置重合而找到准确的零位;
图1c,行程挡片3没有压下行程开关2,使其处于释放状态,其释放状态会被检测到并送至旋转关节5运动控制器,经过相应处理,此时,旋转关节5会顺时针旋转,以便能够保证磁珠6与霍尔传感器7的位置重合而找到准确的零位;
图1b,行程挡片3没有压下行程开关2,使其处于释放状态,但此时恰好处于零位位置,其闭合状态会被检测到并送至旋转关节5运动控制器,如果按照其释放状态经过图1-(c)的相应处理,此时,旋转关节5会顺时针旋转,反而离开零位位置而无法保证找到零位位置,同时考虑到行程开关2从沿着顺时针或者逆时针两个不同方向所引起的状态变换位置会不一致,存在一定的偏差,如图1所示,当旋转关节5顺时针旋转时,位置9为行程开关2的闭合位置,在位置9的右侧都为释放状态,而当旋转关节5逆时针旋转时,位置8为行程开关2的释放位置,在位置8的左侧都为闭合状态,综上述,位置8与位置9之间的行程开关2状态将与转动关节5的旋转方向有关,因此,当行程开关的初始位置恰好处于两个方向的行程开关状态切换位置内时,行程开关状态不确定,以此作为旋转方向的确定依据会造成旋转方向的误判,而无法找到准确的零位。
为了防止上述情况,霍尔传感器7的安装位置离开这一切换范围一定角度,如图1所示,安装在位置8与位置9的右侧,在离切换位置一定角度安装一唯一的目标霍尔传感器7作为零位点,以保证找到机器人关节零位时,行程开关处于释放状态;这样,可以采用同样的处理方法,当检测到行程开关2的状态为闭合时,旋转关节5逆时针旋转,在行程开关2的状态在位置8发生变化,改变为释放状态后,继续旋转直至找到目标霍尔信号和电机Z脉冲信号;当检测到行程开关2的状态为释放时,无论其处于位置8与位置9之间,还是在位置9右侧,旋转关节5都顺时针旋转,在行程开关2的状态在位置9发生变化,改变为闭合状态后,旋转关节5开始逆时针旋转,在行程开关2的状态在位置8发生变化,改变为释放状态后,继续旋转直至找到目标霍尔信号和电机Z脉冲信号。
图2为精确寻找零位的具体步骤:
***上电后,中央控制器发出找零命令,各关节控制器首先判断各行程开关是否处于为闭合状态,
(1)如果为闭合状态,旋转关节逆时针慢速旋转,开始寻找目标霍尔信号,找到目标霍尔信号后,开始捕捉电机轴Z脉冲信号;捕捉到Z脉冲信号的同时,关节停止转动,此时的位置是唯一的,记录当前位置,从而确定机器人的初始位置。
(2)如果为释放状态,那么旋转关节顺时针慢速旋转,直至状态检测电路检测到行程开关处于闭合状态后,旋转关节改变旋转方向,开始逆时针慢速旋转,其后步骤同(1)。
因此,无论最初行程开关2的状态如何,最终旋转关节5都是按照逆时针一个方向旋转去寻找零位,避免了传感器双向检测的回差,大大提高了其定位精度。
以上所述的实施例,只是本发明较优选的具体实施方式的一种,本领域的技术人员在本发明技术方案范围内进行的通常变化和替换都应包含在本发明的保护范围内。
Claims (3)
1.一种机器人关节初始定位方法,包括以下步骤:
(1)机器人在上电工作时,中央控制***向各个关节控制器发出找零指令;
(2)各个关节控制器判断行程开关的闭合或释放状态,以确定关节旋转方向;
(3)根据确定的关节旋转方向,各个关节开始慢速旋转寻找事先确定的霍尔目标信号;
(4)找到目标霍尔信号后,开始捕捉电机轴Z脉冲信号;
(5)捕捉到Z脉冲信号的同时,关节停止转动,此时的位置是唯一的,记录当前位置,从而确定机器人的初始位置;其中
所述关节旋转过程中具有第一位置和第二位置,并且
所述关节顺时针方向旋转经过所述第一位置时,所述行程开关切换为闭合状态;
所述关节逆时针方向旋转经过所述第二位置时,所述行程开关切换为释放状态;
霍尔传感器安装在第一位置与第二位置的右侧,在离第一位置和第二位置一定角度安装唯一的目标霍尔传感器作为零位点,以保证找到机器人关节零位时,所述行程开关处于释放状态;
若步骤(2)中判断行程开关处于闭合状态,则所述关节逆时针旋转;
若步骤(2)中判断行程开关处于释放状态,则所述关节顺时针旋转,在行程开关切换为闭合状态之后,再开始逆时针旋转。
2.根据权利要求1所述的方法,其特征在于,所述关节控制器通过状态检测电路判断行程开关的闭合或释放状态。
3.一种具有关节装置的机器人,其特征在于,所述机器人的关节装置根据如权利要求1-2之一所述的方法进行初始定位。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2010105405190A CN101973035B (zh) | 2010-11-11 | 2010-11-11 | 机器人关节初始位置精确定位方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2010105405190A CN101973035B (zh) | 2010-11-11 | 2010-11-11 | 机器人关节初始位置精确定位方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101973035A CN101973035A (zh) | 2011-02-16 |
CN101973035B true CN101973035B (zh) | 2012-05-23 |
Family
ID=43572956
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2010105405190A Expired - Fee Related CN101973035B (zh) | 2010-11-11 | 2010-11-11 | 机器人关节初始位置精确定位方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN101973035B (zh) |
Families Citing this family (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5893330B2 (ja) * | 2011-10-18 | 2016-03-23 | オリンパス株式会社 | 操作入力装置および操作入力装置の初期化方法 |
CN103192395B (zh) * | 2012-01-06 | 2015-10-28 | 沈阳新松机器人自动化股份有限公司 | 一种多关节机械手询零装置及方法 |
CN106182002B (zh) * | 2016-07-29 | 2018-10-16 | 微创(上海)医疗机器人有限公司 | 机械臂关节的控制***以及控制方法 |
CN106184463B (zh) * | 2016-08-15 | 2019-03-08 | 北京钢铁侠科技有限公司 | 具有零点位置检测功能的仿人机器人关节机构 |
CN106774149B (zh) * | 2016-11-30 | 2019-03-26 | 上海新时达电气股份有限公司 | 工业机器人的调零方法及*** |
CN107186710B (zh) * | 2017-05-14 | 2020-04-07 | 深圳市华成工业控制有限公司 | 一种机械手精确快速回原的方法 |
CN109099833A (zh) * | 2018-09-03 | 2018-12-28 | 中国科学院长春光学精密机械与物理研究所 | 一种用于轻小型稳定平台的轴系角度零位确定方法及*** |
CN109468755B (zh) * | 2018-12-22 | 2021-01-05 | 杰克缝纫机股份有限公司 | 一种缝纫机定位方法、计算机设备和一种缝纫机 |
CN110802593B (zh) * | 2019-11-07 | 2020-11-27 | 北京理工大学 | 一种仿人机器人下肢关节零位标定方法 |
CN112936284B (zh) * | 2021-03-10 | 2022-06-21 | 杭州云深处科技有限公司 | 一种四足机器人开机后找回零位的方法 |
CN114104229B (zh) * | 2021-10-26 | 2022-11-08 | 中国船舶重工集团公司第七一九研究所 | 一种机械腿关节角度限幅的通用性配置方法 |
CN114872025B (zh) * | 2022-06-14 | 2022-11-15 | 上海捷勃特机器人有限公司 | 多关节机器人及其零位标定方法、装置和可读介质 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR100239370B1 (ko) * | 1997-04-23 | 2000-04-01 | 배길성 | 초음파 모터를 이용한 로봇 아암의 관절 |
JP3946711B2 (ja) * | 2004-06-02 | 2007-07-18 | ファナック株式会社 | ロボットシステム |
CN101444915B (zh) * | 2008-12-26 | 2011-05-11 | 北京理工大学 | 基于霍尔信号和电机轴z脉冲的机器人初始精确定位方法 |
CN101444916A (zh) * | 2008-12-26 | 2009-06-03 | 北京理工大学 | 机器人初始精确定位装置 |
CN101574809B (zh) * | 2009-06-16 | 2011-05-11 | 北京华凯汇信息科技有限公司 | 机器人关节零点定位***、方法和装置 |
-
2010
- 2010-11-11 CN CN2010105405190A patent/CN101973035B/zh not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN101973035A (zh) | 2011-02-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101973035B (zh) | 机器人关节初始位置精确定位方法及装置 | |
US10161519B2 (en) | Electronic parking lock apparatus | |
CN102837309A (zh) | 机器人360度旋转关节的防绕线定位装置 | |
CN101574809B (zh) | 机器人关节零点定位***、方法和装置 | |
CN101444916A (zh) | 机器人初始精确定位装置 | |
CN104753425B (zh) | 一种实现永磁同步电机机械零点在线找寻与补偿的方法 | |
CN101444915B (zh) | 基于霍尔信号和电机轴z脉冲的机器人初始精确定位方法 | |
CN109849046B (zh) | 一种舵机转子的回零方法、回零***、舵机及机器人 | |
US8829895B2 (en) | Machine with position determination of relative rotatable members | |
CN101968366B (zh) | 增量传感器的自动回零位的方法及其设备 | |
CN108568839B (zh) | 一种用于scara圆柱副关节的回零装置及其方法 | |
CN109623851B (zh) | 一种机械臂关节零位装置和回零方法 | |
JP2010238174A (ja) | 位置決め装置及び位置決め方法 | |
US11079259B2 (en) | Position encoder with limits | |
JP2015024478A (ja) | ロボット軸の原点復帰方法,装置,制御装置およびプログラム | |
JP5640732B2 (ja) | エンコーダ装置、駆動装置、及びロボット装置 | |
JP3370845B2 (ja) | アブソリュートエンコーダ | |
US10119842B1 (en) | Encoder design and use | |
JP6006069B2 (ja) | エンコーダおよびエンコーダの異常検出方法 | |
WO2022142117A1 (zh) | 双轴同导轨设备回零方法和装置 | |
JP3010107B2 (ja) | エンコーダシステム | |
JP2010249585A (ja) | 現在位置特定装置及び現在位置特定方法 | |
JPH0662322U (ja) | アブソリュートエンコーダ装置 | |
CN114629411A (zh) | 一种用于缝纫机伺服电机的开机零位搜寻方法 | |
CN104682796A (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 | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
C17 | Cessation of patent right | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20120523 Termination date: 20121111 |