CN107186711A - 机械臂的限位保护方法、装置及机器人 - Google Patents
机械臂的限位保护方法、装置及机器人 Download PDFInfo
- Publication number
- CN107186711A CN107186711A CN201710342845.2A CN201710342845A CN107186711A CN 107186711 A CN107186711 A CN 107186711A CN 201710342845 A CN201710342845 A CN 201710342845A CN 107186711 A CN107186711 A CN 107186711A
- Authority
- CN
- China
- Prior art keywords
- joint
- current
- angle value
- default
- value
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 26
- 230000033001 locomotion Effects 0.000 claims abstract description 136
- 238000013507 mapping Methods 0.000 claims description 66
- 230000002633 protecting effect Effects 0.000 claims description 12
- 230000001133 acceleration Effects 0.000 claims description 5
- 238000004364 calculation method Methods 0.000 claims description 5
- 230000006870 function Effects 0.000 description 15
- 230000000694 effects Effects 0.000 description 10
- 230000003068 static effect Effects 0.000 description 6
- 230000008569 process Effects 0.000 description 4
- 241000208340 Araliaceae Species 0.000 description 3
- 235000005035 Panax pseudoginseng ssp. pseudoginseng Nutrition 0.000 description 3
- 235000003140 Panax quinquefolius Nutrition 0.000 description 3
- 235000008434 ginseng Nutrition 0.000 description 3
- 230000008859 change Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 230000035945 sensitivity Effects 0.000 description 2
- 230000000386 athletic effect Effects 0.000 description 1
- 238000004590 computer program Methods 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000010297 mechanical methods and process Methods 0.000 description 1
- 230000005226 mechanical processes and functions Effects 0.000 description 1
- 238000002360 preparation method Methods 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 238000003860 storage Methods 0.000 description 1
- 230000001225 therapeutic effect Effects 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/1674—Programme controls characterised by safety, monitoring, diagnostic
- B25J9/1676—Avoiding collision or forbidden zones
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/06—Safety devices
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种机械臂的限位保护方法、装置及机器人,所述保护方法包括:获取机械臂的关节的当前角度值和当前运动参数;根据所述关节的当前角度值确定当前的安全运动参数范围;其中,在所述关节的可活动范围内,所述关节的每个角度值都一一对应一个安全运动参数范围;当所述关节的当前运动参数超出所述当前的安全运动参数范围时,控制所述关节制动。本发明能够有效地增强机械臂的限位保护的可靠性。
Description
技术领域
本发明涉及机器人控制领域,尤其涉及一种机械臂的限位保护方法、装置及机器人。
背景技术
在机械臂的使用过程中,常常由于操作不当,使得机械臂的运行超出安全的工作范围,导致机械臂损坏。因此,需要对机械臂进行限位保护,以将机械臂限制在安全的工作范围运行。
一般来说,机械臂的限位保护可以通过硬件或者软件的方式来实现。现有的硬件保护方式通过在机械臂的每个轴上设置支柱等限位结构来限制机械臂的工作范围,但在实际应用过程中,机械臂会与限位结构产生硬性碰撞,在某些情况下仍会损坏机械臂。现有的软件保护方式通过检测机械臂的关节的当前角度值,若当前角度值达到关节的预设可活动范围的边界值时,采取制动措施,例如,关节的预设可活动范围为[-90°,90°],当检测到关节的当前角度值为-90°时,采取制动措施。然而,在机械臂的关节的运动过程中,当其角度值达到预设可活动范围的边界值时,其运行速度往往很快,这时采取制动措施可能无法使机械臂的关节及时制动,因此,仍有可能损坏机械臂,保护效果不佳。
发明内容
本发明实施例所要解决的技术问题在于,提供一种机械臂的限位保护方法、装置及机器人,能够有效地增强机械臂的限位保护的可靠性。
为了解决上述技术问题,本发明实施例提出了一种机械臂的限位保护方法,包括:
获取机械臂的关节的当前角度值和当前运动参数;
根据所述关节的当前角度值确定当前的安全运动参数范围;其中,在所述关节的可活动范围内,所述关节的每个角度值都一一对应一个安全运动参数范围;
当所述关节的当前运动参数超出所述当前的安全运动参数范围时,控制所述关节制动。
优选地,所述根据所述关节的当前角度值确定当前的安全运动参数范围,具体包括:
根据预设的第一映射关系确定所述当前角度值下的安全运动参数范围的上限值;其中,当所述关节的角度值大于预设的角度门限值,且越接近所述关节的可活动范围的上边界值时,根据所述第一映射关系所确定的安全运动参数范围的上限值的绝对值越小;
根据预设的第二映射关系确定所述当前角度值下的安全运动参数范围的下限值;其中,当所述关节的角度值小于预设的角度门限值,且越接近所述关节的可活动范围的下边界值时,根据所述第二映射关系所确定的安全运动参数范围的下限值的绝对值越小。
优选地,
所述第一映射关系具体为:且
所述第二映射关系具体为:
其中,为所述安全运动参数范围的上限值,为所述安全运动参数范围的下限值,qi为所述关节的角度值,为预设的运动参数范围的上限值,为预设的运动参数范围的下限值,为所述关节的可活动范围的上边界值,为所述关节的可活动范围的下边界值,为预设的角度门限值,α为预设的曲率系数,且α大于0。
优选地,
所述第一映射关系具体为:且
所述第二映射关系具体为:
其中,为所述安全运动参数范围的上限值,为所述安全运动参数范围的下限值,qi为所述关节的角度值,为预设的运动参数范围的上限值,为预设的运动参数范围的下限值,为所述关节的可活动范围的上边界值,为所述关节的可活动范围的下边界值,为预设的角度门限值,β为预设的曲率系数,且β不等于0。
优选地,所述当所述关节的当前运动参数超出所述当前的安全运动参数范围时,控制所述关节制动,具体包括:
当所述关节的当前运动参数超出所述当前的安全运动参数范围时,将所述当前角度值作为所述关节的停止角度值;
根据所述停止角度值控制所述关节制动,以使所述关节静止在所述停止角度值所对应的位置。
优选地,所述根据所述停止角度值控制所述关节制动,具体包括:
根据所述停止角度值生成制动信号;所述制动信号的计算公式为:其中,为制动信号,kv为预设的微分增益参数,kq为预设的比例增益参数,ωi(t)为所述关节的当前角速度,qi(t)为所述关节的当前角度值,为所述停止角度值;
根据所述制动信号控制所述关节制动。
优选地,所述关节的运动参数为所述关节的力矩参数、速度参数或角加速度参数中的任意一种,并且,所述预设的角度门限值等于所述关节的可活动范围的上边界值和下边界值的和的一半。
本发明实施例还提出了一种机械臂的限位保护装置,包括:
参数获取模块,用于获取机械臂的关节的当前角度值和当前运动参数;
参数范围确定模块,用于根据所述关节的当前角度值确定当前的安全运动参数范围;其中,在所述关节的可活动范围内,所述关节的每个角度值都一一对应一个安全运动参数范围;以及,
关节制动模块,用于当所述关节的当前运动参数超出所述当前的安全运动参数范围时,控制所述关节制动。
优选地,所述参数范围确定模块具体包括:
上限值确定单元,用于根据预设的第一映射关系确定所述当前角度值下的安全运动参数范围的上限值;其中,当所述关节的角度值大于预设的角度门限值,且越接近所述关节的可活动范围的上边界值时,根据所述第一映射关系所确定的安全运动参数范围的上限值的绝对值越小;以及,
下限值确定单元,用于根据预设的第二映射关系确定所述当前角度值下的安全运动参数范围的下限值;其中,当所述关节的角度值小于预设的角度门限值,且越接近所述关节的可活动范围的下边界值时,根据所述第二映射关系所确定的安全运动参数范围的下限值的绝对值越小。
优选地,
所述第一映射关系具体为:且
所述第二映射关系具体为:
其中,为所述安全运动参数范围的上限值,为所述安全运动参数范围的下限值,qi为所述关节的角度值,为预设的运动参数范围的上限值,为预设的运动参数范围的下限值,为所述关节的可活动范围的上边界值,为所述关节的可活动范围的下边界值,为预设的角度门限值,α为预设的曲率系数,且α大于0。
优选地,
所述第一映射关系具体为:且
所述第二映射关系具体为:
其中,为所述安全运动参数范围的上限值,为所述安全运动参数范围的下限值,qi为所述关节的角度值,为预设的运动参数范围的上限值,为预设的运动参数范围的下限值,为所述关节的可活动范围的上边界值,为所述关节的可活动范围的下边界值,为预设的角度门限值,β为预设的曲率系数,且β不等于0。
优选地,所述关节制动模块具体包括:
停止角确定单元,用于当所述关节的当前运动参数超出所述当前的安全运动参数范围时,将所述当前角度值作为所述关节的停止角度值;以及,
关节制动单元,用于根据所述停止角度值控制所述关节制动,以使所述关节静止在所述停止角度值所对应的位置。
优选地,所述关节制动单元具体包括:
制动信号生成子单元,用于根据所述停止角度值生成制动信号;所述制动信号的计算公式为:其中,为制动信号,kv为预设的微分增益参数,kq为预设的比例增益参数,ωi(t)为所述关节的当前角速度,qi(t)为所述关节的当前角度值,为所述停止角度值;以及,
关节制动子单元,用于根据所述制动信号控制所述关节制动。
优选地,所述关节的运动参数为所述关节的力矩参数、速度参数或角加速度参数中的任意一种,并且,所述预设的角度门限值等于所述关节的可活动范围的上边界值和下边界值的和的一半。
实施本发明实施例,具有如下有益效果:
本发明实施例提供的机械臂的限位保护方法、装置及机器人,根据机械臂的关节的当前关节角度值确定当前的安全运动参数范围,进而在当前关节参数超出当前的安全运动参数范围时,控制关节制动。其中,在关节的可活动范围内,关节的每个角度值都一一对应一个安全运动参数范围,可见,本发明中的安全运动参数范围根据关节的当前角度值动态更新,有效地增强了机械臂的限位保护的可靠性。
附图说明
图1是本发明提供的机械臂的限位保护方法的一个实施例的流程示意图;
图2是本发明提供的第一映射关系和第二映射关系的一个实施例的函数曲线示意图;
图3是本发明提供的第一映射关系和第二映射关系的另一个实施例的函数曲线示意图;
图4是本发明提供的机械臂的限位保护装置的一个实施例的结构示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
请参阅图1,是本发明提供的机械臂的限位保护方法的一个实施例的流程示意图。所述机械臂的限位保护方法可以由机械臂的限位保护装置来执行,并至少包括如下步骤:
S11、获取机械臂的关节的当前角度值和当前运动参数;
需要说明的是,机械臂是机器人技术领域中最广泛应用的自动化机械装置,其广泛应用于工业制造、医学治疗、娱乐服务、军事、半导体制造以及太空探索等领域。尽管它们的形态各有不同,但它们都有一个共同的特点,就是能够接受指令,并根据指令按照预设的轨迹运动。
在实际应用中,控制装置根据用户需求向电机发送相应的运动控制指令,以控制机械臂的关节进行相应的运动。在机械臂运动期间,可以实时获取机械臂的关节的角度值和运动参数。其中,关节的运动参数为所述关节的力矩参数、速度参数或角加速度参数中的任意一种,例如,机械臂工作在力矩模式下,控制装置根据用户需求向电机发送力矩控制指令,在机械臂的关节进行相应的运动时,获取机械臂的关节的当前力矩参数。关节的角度值指的是关节当前所处的位置与参考零位置之间的夹角值。并且,关节的角度值和运动参数均带有正负符号,其正负号代表运动方向。
需要说明的是,一个机械臂一般包括n个关节,n为正整数,当机械臂的各个关节同时运动时,分别获取各个关节的当前角度值和当前运动参数。
S12、根据所述关节的当前角度值确定当前的安全运动参数范围;其中,在所述关节的可活动范围内,所述关节的每个角度值都一一对应一个安全运动参数范围;
在本发明实施例中,安全运动参数范围指的是关节的运动参数的安全取值范围,若关节的当前运动参数超出当前安全运动运动参数范围,则说明若关节继续以当前运动参数运动,则有可能被损坏。另外,关节的可活动范围指的是关节可活动的角度范围,即关节的角度值不能超出的范围,关节的可活动范围可以由用户根据需求预先设置,例如预先设置关节的可活动范围的上边界值为下边界值为则关节的可活动范围为一般来说,
在本发明实施例中,在关节运动过程中,每获得一个当前时刻的角度值,则确定一个当前角度值下的安全运动参数范围,可见,安全运动参数范围是根据关节的当前角度值动态更新的。并且,在关节的可活动范围内,关节的每个角度值都一一对应一个安全运动参数范围。需要说明的是,关节的每个角度值对应的安全运动参数范围一般是各不相同的。
S13、当所述关节的当前运动参数超出所述当前的安全运动参数范围时,控制所述关节制动。
在本发明实施例中,将获得的当前运动参数和根据当前角度值所确定的当前的安全运动参数范围进行对比,若当前运动参数小于当前的安全运动参数范围的下限值或者大于当前的安全运动参数范围的上限值,则判定关节的当前运动参数超出了当前的安全运动参数范围,此时,控制关节制动。其中,控制关节制动的方式有多种,例如,输出一次性制动指令至电机,随后立即控制关节制动,关节在惯性作用下继续往前运动一小段距离后,最终静止在某一位置。
综上所述,本发明实施例提供的机械臂的限位保护方法,根据机械臂的关节的当前关节角度值确定当前的安全运动参数范围,进而在当前关节参数超出当前的安全运动参数范围时,控制关节制动。其中,在关节的可活动范围内,关节的每个角度值都一一对应一个安全运动参数范围,可见,本发明中的安全运动参数范围根据关节的当前角度值动态更新,有效地增强了机械臂的限位保护的可靠性。
在一个优选的实施方式中,所述根据所述关节的当前角度值确定当前的安全运动参数范围,具体包括:
根据预设的第一映射关系确定所述当前角度值下的安全运动参数范围的上限值;其中,当所述关节的角度值大于预设的角度门限值,且越接近所述关节的可活动范围的上边界值时,根据所述第一映射关系所确定的安全运动参数范围的上限值的绝对值越小;
根据预设的第二映射关系确定所述当前角度值下的安全运动参数范围的下限值;其中,当所述关节的角度值小于预设的角度门限值,且越接近所述关节的可活动范围的下边界值时,根据所述第二映射关系所确定的安全运动参数范围的下限值的绝对值越小。
在本实施方式中,根据预设的第一映射关系确定当前角度值下的安全运动参数范围的上限值。其中,预设的第一映射关系可以为预设的第一映射关系表,该第一映射关系表中记录有若干个角度值以及与该若干个角度值一一对应的若干个安全运动参数范围的上限值,则当获取到关节的当前角度值时,通过查询预设的第一映射关系表,可以获得与该当前角度值唯一对应的安全运动参数范围的上限值。另外,在其他可选的实施方式中,预设的第一映射关系还可以为预设的第一映射函数,该第一映射函数为以角度值为自变量,以安全运动参数范围的上限值为因变量,则当获取到关节的当前角度值时,通过将该当前角度值代入该第一映射映射函数,即可获得与该当前角度值唯一对应的安全运动参数范围的上限值。需要说明的是,根据预设的第二映射关系确定当前角度值下的安全运动参数范围的下限值与根据预设的第一映射关系确定当前角度值下的安全运动参数范围的上限值的原理类似,均可以采用多种确定方式,例如上述两种方式,此处不加赘述。
在本实施方式中,当关节朝可活动范围的上边界方向运动时,关节的运动参数为正值,安全运动参数范围的上限值也为正值。当关节的角度值大于预设的角度门限值时,若关节的当前角度值距离可活动范围的上边界值较远,则根据关节的当前角度值确定的当前安全运动参数范围的上限值较大,说明关节可以以较大的运动参数运动,但若关节的当前角度值距离可活动范围的上边界值较近,则根据关节的当前角度值确定的当前安全运动参数范围的上限值相对较小,此时,若关节仍以较大的运动参数运动,则容易超出相应的安全运动参数范围的上限值,从而触发制动操作。另外,关节也可以朝可活动范围的下边界方向运动,这种情况下,关节的运动参数为负值,安全运动参数范围的下限值也为负值。当关节的角度值小于预设的角度门限值时,若关节的当前角度值距离可活动范围的下边界值较远,则根据关节的当前角度值确定的当前安全运动参数范围的下限值越小,即其绝对值较大,说明关节可以以绝对值较大的运动参数运动,但若关节的当前角度值距离可活动范围的下边界值较近,则根据关节的当前角度值确定的当前安全运动参数范围的下限值相对较大,即其绝对值较小,此时,若关节仍以绝对值较大的运动参数运动,则容易超出相应的安全运动参数范围的下限值,从而触发制动操作。因此,本实施方式能够对关节的当前运动情况进行提前判断,当判定以当前运动参数继续运动会导致来不及制动的问题时,立即采取制动措施,能够有效地增强了机械臂的限位保护的可靠性。
需要说明的是,在关节朝可活动范围的上边界方向运动的情况下,当关节的角度值小于预设的角度门限值时,根据第一映射关系所确定的安全运动参数范围的上限值可以为常量A,优选地,常量A可以为预设的运动参数范围的上限值,即表示在这种情况下,关节可以以预设的运动参数范围的上限值运动到预设的角度门限值所对应的位置。在关节朝可活动范围的下边界方向运动的情况下,当关节的角度值大于预设的角度门限值时,根据第一映射关系所确定的安全运动参数范围的下限值可以为常量B,优选地,常量B可以为预设的运动参数范围的下限值,即表示在这种情况下,关节可以以预设的运动参数范围的下限值运动到预设的角度门限值所对应的位置。优选地,预设的角度门限值等于关节的可活动范围的上边界值和下边界值的和的一半,例如,可活动范围的下边界值为-90°,可活动范围的上边界值为90°时,预设的角度门限值可以设置为0。
在一个优选的实施方式中,
所述第一映射关系具体为:且
所述第二映射关系具体为:
其中,为所述安全运动参数范围的上限值,为所述安全运动参数范围的下限值,qi为所述关节的角度值,为预设的运动参数范围的上限值,为预设的运动参数范围的下限值,为所述关节的可活动范围的上边界值,为所述关节的可活动范围的下边界值,为预设的角度门限值,α为预设的曲率系数,且α大于0。
请参阅图2,是本实施方式中第一映射关系和第二映射关系的函数曲线示意图,图中以关节的安全运动参数范围的限值τi为纵坐标,以关节的角度值qi为横坐标。
在本实施方式中,α值越接近0,函数曲线越陡峭,反之函数曲线越平缓。可以理解的是,在关节朝可活动范围的上边界方向运动的情况下,当关节的角度值大于预设的角度门限值时,同一个角度值,在更为平缓的函数曲线下,根据其所确定的安全运动参数范围的上限值相对较小,采取制动操作后,关节静止的位置将距离可活动范围的上边界值较远。相对地,在更为陡峭的函数曲线下,根据其所确定的安全运动参数范围的上限值相对较大,此时采取制动操作,关节静止的位置将距离可活动范围的上边界值较近。另外,在关节朝可活动范围的下边界方向运动的情况下,同理类推,此处不加赘述。由此可见,能够根据用户需求设置α值,从而改变制动的灵敏程度,使得控制过程更加人性化。
另外,为预设的运动参数范围的上限值,为预设的运动参数范围的下限值,一般来说,具体地,若关节的运动参数为力矩参数,则为预设的力矩参数范围的上限值,为预设的力矩参数范围的下限值。
或者,在另一个优选的实施方式中,
所述第一映射关系具体为:且
所述第二映射关系具体为:
其中,为所述安全运动参数范围的上限值,为所述安全运动参数范围的下限值,qi为所述关节的角度值,为预设的运动参数范围的上限值,为预设的运动参数范围的下限值,为所述关节的可活动范围的上边界值,为所述关节的可活动范围的下边界值,为预设的角度门限值,β为预设的曲率系数,且β不等于0。
请参阅图3,是本实施方式中第一映射关系和第二映射关系的函数曲线示意图,图中以关节的安全运动参数范围的限值τi为纵坐标,以关节的角度值qi为横坐标。
在本实施方式中,β2值越小,函数曲线越陡峭,反之函数曲线越平缓。可以理解的是,在关节朝可活动范围的上边界方向运动的情况下,当关节的角度值大于预设的角度门限值时,同一个角度值,在更为平缓的函数曲线下,根据其所确定的安全运动参数范围的上限值相对较小,采取制动操作后,关节静止的位置将距离可活动范围的上边界值较远。相对地,在更为陡峭的函数曲线下,根据其所确定的安全运动参数范围的上限值相对较大,此时采取制动操作,关节静止的位置将距离可活动范围的上边界值较近。另外,在关节朝可活动范围的下边界方向运动的情况下,同理类推,此处不加赘述。由此可见,能够根据用户需求设置β值,从而改变制动的灵敏程度,使得控制过程更加人性化。
另外,为预设的运动参数范围的上限值,为预设的运动参数范围的下限值,一般来说,具体地,若关节的运动参数为力矩参数,则为预设的力矩参数范围的上限值,为预设的力矩参数范围的下限值。
在一个优选的实施方式中,所述当所述关节的当前运动参数超出所述当前的安全运动参数范围时,控制所述关节制动,具体包括:
当所述关节的当前运动参数超出所述当前的安全运动参数范围时,将所述当前角度值作为所述关节的停止角度值;
根据所述停止角度值控制所述关节制动,以使所述关节静止在所述停止角度值所对应的位置。
进一步地,所述根据所述停止角度值控制所述关节制动,具体包括:
根据所述停止角度值生成制动信号;所述制动信号的计算公式为:其中,为制动信号,kv为预设的微分增益参数,kq为预设的比例增益参数,ωi(t)为所述关节的当前角速度,qi(t)为所述关节的当前角度值,为所述停止角度值;
根据所述制动信号控制所述关节制动。
需要说明的是,在实际操作过程中,当控制装置向电机发送相应的制动信号后,关节往往还会在惯性作用下继续往前运动一小段距离,再缓缓停下来。在本实施方式中,当判定关节的当前运动参数超出当前的安全运动参数范围时,将当前角度值作为关节的停止角度值,并由控制装置向电机发送相应的制动信号,当关节在惯性作用下继续往前运动一小段距离,缓缓停下后,再使关节往回运动一段,最终静止在停止角度值所对应的位置,本实施方式中的制动方式较为简单,且鲁棒性较好。
相应的,本发明实施例还提供一种机械臂的限位保护装置,能够实现本发明实施例的提供的机械臂的限位保护方法中的所有流程。
请参阅图4,是本发明提供的机械臂的限位保护装置的一个实施例的结构示意图,所述装置包括:
参数获取模块11,用于获取机械臂的关节的当前角度值和当前运动参数;
参数范围确定模块12,用于根据所述关节的当前角度值确定当前的安全运动参数范围;其中,在所述关节的可活动范围内,所述关节的每个角度值都一一对应一个安全运动参数范围;以及,
关节制动模块13,用于当所述关节的当前运动参数超出所述当前的安全运动参数范围时,控制所述关节制动。
本发明实施例提供的机械臂的限位保护装置,根据机械臂的关节的当前关节角度值确定当前的安全运动参数范围,进而在当前关节参数超出当前的安全运动参数范围时,控制关节制动。其中,在关节的可活动范围内,关节的每个角度值都一一对应一个安全运动参数范围,可见,本发明中的安全运动参数范围根据关节的当前角度值动态更新,有效地增强了机械臂的限位保护的可靠性。
在一个优选的实施方式中,所述参数范围确定模块12具体包括:
上限值确定单元,用于根据预设的第一映射关系确定所述当前角度值下的安全运动参数范围的上限值;其中,当所述关节的角度值大于预设的角度门限值,且越接近所述关节的可活动范围的上边界值时,根据所述第一映射关系所确定的安全运动参数范围的上限值的绝对值越小;以及,
下限值确定单元,用于根据预设的第二映射关系确定所述当前角度值下的安全运动参数范围的下限值;其中,当所述关节的角度值小于预设的角度门限值,且越接近所述关节的可活动范围的下边界值时,根据所述第二映射关系所确定的安全运动参数范围的下限值的绝对值越小。
在一个优选的实施方式中,
所述第一映射关系具体为:且
所述第二映射关系具体为:
其中,为所述安全运动参数范围的上限值,为所述安全运动参数范围的下限值,qi为所述关节的角度值,为预设的运动参数范围的上限值,为预设的运动参数范围的下限值,为所述关节的可活动范围的上边界值,为所述关节的可活动范围的下边界值,为预设的角度门限值,α为预设的曲率系数,且α大于0。
或者,在另一个优选的实施方式中,
所述第一映射关系具体为:且
所述第二映射关系具体为:
其中,为所述安全运动参数范围的上限值,为所述安全运动参数范围的下限值,qi为所述关节的角度值,为预设的运动参数范围的上限值,为预设的运动参数范围的下限值,为所述关节的可活动范围的上边界值,为所述关节的可活动范围的下边界值,为预设的角度门限值,β为预设的曲率系数,且β不等于0。
优选地,所述关节制动模块13具体包括:
停止角确定单元,用于当所述关节的当前运动参数超出所述当前的安全运动参数范围时,将所述当前角度值作为所述关节的停止角度值;以及,
关节制动单元,用于根据所述停止角度值控制所述关节制动,以使所述关节静止在所述停止角度值所对应的位置。
进一步地,所述关节制动单元具体包括:
制动信号生成子单元,用于根据所述停止角度值生成制动信号;所述制动信号的计算公式为:其中,为制动信号,kv为预设的微分增益参数,kq为预设的比例增益参数,ωi(t)为所述关节的当前角速度,qi(t)为所述关节的当前角度值,为所述停止角度值;以及,
关节制动子单元,用于根据所述制动信号控制所述关节制动。
在一个优选的实施方式中,所述关节的运动参数为所述关节的力矩参数、速度参数或角加速度参数中的任意一种;
在一个优选的实施方式中,所述预设的角度门限值等于所述关节的可活动范围的上边界值和下边界值的和的一半。
本发明实施例提供的机械臂的限位保护装置,根据机械臂的关节的当前关节角度值确定当前的安全运动参数范围,进而在当前关节参数超出当前的安全运动参数范围时,控制关节制动。其中,在关节的可活动范围内,关节的每个角度值都一一对应一个安全运动参数范围,可见,本发明中的安全运动参数范围根据关节的当前角度值动态更新,有效地增强了机械臂的限位保护的可靠性。
相应的,本发明实施例还提供一种机器人,包括上述的机械臂的限位保护装置。
本发明实施例提供的机器人,根据其机械臂的关节的当前关节角度值确定当前的安全运动参数范围,若当前关节参数超出当前的安全运动参数范围,则及时地控制相应的关节制动。其中,在关节的可活动范围内,关节的每个角度值都一一对应一个安全运动参数范围,可见,安全运动参数范围根据关节的当前角度值动态更新,能够有效地增强其机械臂的限位保护的可靠性。
以上所述是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和变形,这些改进和变形也视为本发明的保护范围。
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的程序可存储于一计算机可读取存储介质中,该程序在执行时,可包括如上述各方法的实施例的流程。其中,所述的存储介质可为磁碟、光盘、只读存储记忆体(Read-Only Memory,ROM)或随机存储记忆体(Random AccessMemory,RAM)等。
Claims (10)
1.一种机械臂的限位保护方法,其特征在于,包括:
获取机械臂的关节的当前角度值和当前运动参数;
根据所述关节的当前角度值确定当前的安全运动参数范围;其中,在所述关节的可活动范围内,所述关节的每个角度值都一一对应一个安全运动参数范围;
当所述关节的当前运动参数超出所述当前的安全运动参数范围时,控制所述关节制动。
2.如权利要求1所述的机械臂的限位保护方法,其特征在于,所述根据所述关节的当前角度值确定当前的安全运动参数范围,具体包括:
根据预设的第一映射关系确定所述当前角度值下的安全运动参数范围的上限值;其中,当所述关节的角度值大于预设的角度门限值,且越接近所述关节的可活动范围的上边界值时,根据所述第一映射关系所确定的安全运动参数范围的上限值的绝对值越小;
根据预设的第二映射关系确定所述当前角度值下的安全运动参数范围的下限值;其中,当所述关节的角度值小于预设的角度门限值,且越接近所述关节的可活动范围的下边界值时,根据所述第二映射关系所确定的安全运动参数范围的下限值的绝对值越小。
3.如权利要求2所述的机械臂的限位保护方法,其特征在于,
所述第一映射关系具体为:且
所述第二映射关系具体为:
其中,为所述安全运动参数范围的上限值,为所述安全运动参数范围的下限值,qi为所述关节的角度值,为预设的运动参数范围的上限值,为预设的运动参数范围的下限值,为所述关节的可活动范围的上边界值,为所述关节的可活动范围的下边界值,为预设的角度门限值,α为预设的曲率系数,且α大于0。
4.如权利要求2所述的机械臂的限位保护方法,其特征在于,
所述第一映射关系具体为:且
所述第二映射关系具体为:
其中,为所述安全运动参数范围的上限值,为所述安全运动参数范围的下限值,qi为所述关节的角度值,为预设的运动参数范围的上限值,为预设的运动参数范围的下限值,为所述关节的可活动范围的上边界值,为所述关节的可活动范围的下边界值,为预设的角度门限值,β为预设的曲率系数,且β不等于0。
5.如权利要求1所述的机械臂的限位保护方法,其特征在于,所述当所述关节的当前运动参数超出所述当前的安全运动参数范围时,控制所述关节制动,具体包括:
当所述关节的当前运动参数超出所述当前的安全运动参数范围时,将所述当前角度值作为所述关节的停止角度值;
根据所述停止角度值控制所述关节制动,以使所述关节静止在所述停止角度值所对应的位置。
6.如权利要求5所述的机械臂的限位保护方法,其特征在于,所述根据所述停止角度值控制所述关节制动,具体包括:
根据所述停止角度值生成制动信号;所述制动信号的计算公式为:其中,为制动信号,kv为预设的微分增益参数,kq为预设的比例增益参数,ωi(t)为所述关节的当前角速度,qi(t)为所述关节的当前角度值,为所述停止角度值;
根据所述制动信号控制所述关节制动。
7.如权利要求1至6任一项所述的机械臂的限位保护方法,其特征在于,所述关节的运动参数为所述关节的力矩参数、速度参数或角加速度参数中的任意一种,并且,所述预设的角度门限值等于所述关节的可活动范围的上边界值和下边界值的和的一半。
8.一种机械臂的限位保护装置,其特征在于,包括:
参数获取模块,用于获取机械臂的关节的当前角度值和当前运动参数;
参数范围确定模块,用于根据所述关节的当前角度值确定当前的安全运动参数范围;其中,在所述关节的可活动范围内,所述关节的每个角度值都一一对应一个安全运动参数范围;以及,
关节制动模块,用于当所述关节的当前运动参数超出所述当前的安全运动参数范围时,控制所述关节制动。
9.如权利要求8所述的机械臂的限位保护装置,其特征在于,所述参数范围确定模块具体包括:
上限值确定单元,用于根据预设的第一映射关系确定所述当前角度值下的安全运动参数范围的上限值;其中,当所述关节的角度值大于预设的角度门限值,且越接近所述关节的可活动范围的上边界值时,根据所述第一映射关系所确定的安全运动参数范围的上限值的绝对值越小;以及,
下限值确定单元,用于根据预设的第二映射关系确定所述当前角度值下的安全运动参数范围的下限值;其中,当所述关节的角度值小于预设的角度门限值,且越接近所述关节的可活动范围的下边界值时,根据所述第二映射关系所确定的安全运动参数范围的下限值的绝对值越小。
10.一种机器人,其特征在于,包括如权利要求8或9所述的机械臂的限位保护装置。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710342845.2A CN107186711B (zh) | 2017-05-12 | 2017-05-12 | 机械臂的限位保护方法、装置及机器人 |
PCT/CN2017/104658 WO2018205488A1 (zh) | 2017-05-12 | 2017-09-29 | 机械臂的限位保护方法、装置及机器人 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710342845.2A CN107186711B (zh) | 2017-05-12 | 2017-05-12 | 机械臂的限位保护方法、装置及机器人 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107186711A true CN107186711A (zh) | 2017-09-22 |
CN107186711B CN107186711B (zh) | 2021-06-15 |
Family
ID=59873618
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710342845.2A Active CN107186711B (zh) | 2017-05-12 | 2017-05-12 | 机械臂的限位保护方法、装置及机器人 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN107186711B (zh) |
WO (1) | WO2018205488A1 (zh) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2018205488A1 (zh) * | 2017-05-12 | 2018-11-15 | 广州视源电子科技股份有限公司 | 机械臂的限位保护方法、装置及机器人 |
CN109746936A (zh) * | 2018-12-19 | 2019-05-14 | 北京镁伽机器人科技有限公司 | 机器人的关节限位方法、装置、***及存储介质 |
CN110405749A (zh) * | 2018-04-27 | 2019-11-05 | 深圳市优必选科技有限公司 | 关节限位检测方法、装置、机器人及计算机可读存储介质 |
CN111015742A (zh) * | 2019-12-23 | 2020-04-17 | 上海有个机器人有限公司 | 智能仓储管理中心关节机械臂保护方法和保护*** |
CN111730601A (zh) * | 2020-07-20 | 2020-10-02 | 季华实验室 | 一种穿戴式示教器示教控制方法、装置及电子设备 |
CN113070881A (zh) * | 2021-04-02 | 2021-07-06 | 深圳市优必选科技股份有限公司 | 机器人运动控制方法、装置和机器人 |
CN114012721A (zh) * | 2021-10-28 | 2022-02-08 | 珠海格力电器股份有限公司 | 机器人刹车控制方法、装置及相关设备 |
CN118061194A (zh) * | 2024-04-17 | 2024-05-24 | 自贡创赢智能科技有限公司 | 用于检测模型驱动臂工作状态的方法及装置、介质和机械臂 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS6140612A (ja) * | 1984-08-01 | 1986-02-26 | Shinko Electric Co Ltd | 産業用ロボツト |
EP0382231A1 (de) * | 1989-02-09 | 1990-08-16 | Man Ghh Logistics Gmbh | Verfahren und Anordnung zur Begrenzung des Bewegungsbereichs eines Krans |
CN102323822A (zh) * | 2011-05-09 | 2012-01-18 | 无锡引域智能机器人有限公司 | 一种避免工业机器人碰撞工人的方法 |
JP2015174185A (ja) * | 2014-03-14 | 2015-10-05 | 三菱重工業株式会社 | ロボットのシミュレーション装置及び方法、制御装置、及びロボットシステム |
CN106182040A (zh) * | 2014-12-23 | 2016-12-07 | 库卡罗伯特有限公司 | 机器人*** |
CN106182075A (zh) * | 2016-07-28 | 2016-12-07 | 上海交通大学 | 两自由度通用机械臂关节模块驱动***及方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6055014B2 (ja) * | 2015-03-23 | 2016-12-27 | ファナック株式会社 | 物または人との接触を検知する機能を有するロボット制御装置 |
CN105479490A (zh) * | 2015-12-24 | 2016-04-13 | 华中科技大学 | 一种双机器人实时动态避障装置及其避障方法 |
CN105437232B (zh) * | 2016-01-11 | 2017-07-04 | 湖南拓视觉信息技术有限公司 | 一种控制多关节移动机器人避障的方法及装置 |
CN106584461B (zh) * | 2016-12-21 | 2019-02-15 | 西安科技大学 | 多约束条件下七自由度仿人机械臂的逆运动学拟人臂构型优化方法 |
CN107186711B (zh) * | 2017-05-12 | 2021-06-15 | 广州视源电子科技股份有限公司 | 机械臂的限位保护方法、装置及机器人 |
-
2017
- 2017-05-12 CN CN201710342845.2A patent/CN107186711B/zh active Active
- 2017-09-29 WO PCT/CN2017/104658 patent/WO2018205488A1/zh active Application Filing
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS6140612A (ja) * | 1984-08-01 | 1986-02-26 | Shinko Electric Co Ltd | 産業用ロボツト |
EP0382231A1 (de) * | 1989-02-09 | 1990-08-16 | Man Ghh Logistics Gmbh | Verfahren und Anordnung zur Begrenzung des Bewegungsbereichs eines Krans |
CN102323822A (zh) * | 2011-05-09 | 2012-01-18 | 无锡引域智能机器人有限公司 | 一种避免工业机器人碰撞工人的方法 |
JP2015174185A (ja) * | 2014-03-14 | 2015-10-05 | 三菱重工業株式会社 | ロボットのシミュレーション装置及び方法、制御装置、及びロボットシステム |
CN106182040A (zh) * | 2014-12-23 | 2016-12-07 | 库卡罗伯特有限公司 | 机器人*** |
CN106182075A (zh) * | 2016-07-28 | 2016-12-07 | 上海交通大学 | 两自由度通用机械臂关节模块驱动***及方法 |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2018205488A1 (zh) * | 2017-05-12 | 2018-11-15 | 广州视源电子科技股份有限公司 | 机械臂的限位保护方法、装置及机器人 |
CN110405749A (zh) * | 2018-04-27 | 2019-11-05 | 深圳市优必选科技有限公司 | 关节限位检测方法、装置、机器人及计算机可读存储介质 |
CN110405749B (zh) * | 2018-04-27 | 2020-12-15 | 深圳市优必选科技有限公司 | 关节限位检测方法、装置、机器人及计算机可读存储介质 |
CN109746936A (zh) * | 2018-12-19 | 2019-05-14 | 北京镁伽机器人科技有限公司 | 机器人的关节限位方法、装置、***及存储介质 |
CN111015742A (zh) * | 2019-12-23 | 2020-04-17 | 上海有个机器人有限公司 | 智能仓储管理中心关节机械臂保护方法和保护*** |
CN111730601A (zh) * | 2020-07-20 | 2020-10-02 | 季华实验室 | 一种穿戴式示教器示教控制方法、装置及电子设备 |
CN113070881A (zh) * | 2021-04-02 | 2021-07-06 | 深圳市优必选科技股份有限公司 | 机器人运动控制方法、装置和机器人 |
CN114012721A (zh) * | 2021-10-28 | 2022-02-08 | 珠海格力电器股份有限公司 | 机器人刹车控制方法、装置及相关设备 |
CN118061194A (zh) * | 2024-04-17 | 2024-05-24 | 自贡创赢智能科技有限公司 | 用于检测模型驱动臂工作状态的方法及装置、介质和机械臂 |
CN118061194B (zh) * | 2024-04-17 | 2024-07-09 | 自贡创赢智能科技有限公司 | 用于检测模型驱动臂工作状态的方法及装置、介质和机械臂 |
Also Published As
Publication number | Publication date |
---|---|
WO2018205488A1 (zh) | 2018-11-15 |
CN107186711B (zh) | 2021-06-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107186711A (zh) | 机械臂的限位保护方法、装置及机器人 | |
Wiedebach et al. | Walking on partial footholds including line contacts with the humanoid robot atlas | |
US11045945B2 (en) | Method for controlling walking of robot and robot | |
US9073209B2 (en) | Walking robot and control method thereof | |
EP2426037B1 (en) | Walking robot and control method thereof | |
US20130144439A1 (en) | Walking robot and control method thereof | |
Chipalkatty et al. | Human-in-the-loop: MPC for shared control of a quadruped rescue robot | |
CN107168351A (zh) | 一种足式机器人的柔顺控制方法及装置 | |
WO2000057340A1 (en) | Non-linear muscle-like compliant controller | |
CN107116553A (zh) | 一种机械臂的操作方法及装置 | |
JP2014508660A (ja) | 人型ロボットの転倒損傷低減制御法 | |
CN108372505A (zh) | 一种基于动力学的机器人的碰撞检测算法及*** | |
Lee et al. | Fall on backpack: Damage minimizing humanoid fall on targeted body segment using momentum control | |
Junkai et al. | A control system for active ball handling in the RoboCup middle size league | |
Lee et al. | Fall on backpack: Damage minimization of humanoid robots by falling on targeted body segments | |
Cardona et al. | Reduction of impact force in falling robots using variable stiffness | |
Lofaro et al. | Humanoid throwing: Design of collision-free trajectories with sparse reachable maps | |
Dao et al. | Sim-to-real learning for humanoid box loco-manipulation | |
Hosseinmemar et al. | Closed-loop push recovery for inexpensive humanoid robots | |
CN112757301B (zh) | 机器人抗扰动控制方法、装置、电子设备及存储介质 | |
Walker et al. | A dual-flywheel ungrounded haptic feedback system provides single-axis moment pulses for clear direction signals | |
Liu et al. | Sensorless contact force observation with friction distinguishment in heavy legged robot via pmsm load torque and imu | |
JPH0248283A (ja) | 歩行脚運動軌跡制御装置 | |
Apostolopoulos et al. | Energy efficient and robust balancing with motion primitive switching | |
Wu et al. | Sliding mode hybrid impedance control of manipulators for complex interaction tasks |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
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 |