CN113635306B - 机器人紧急制动方法、机器人及存储介质 - Google Patents
机器人紧急制动方法、机器人及存储介质 Download PDFInfo
- Publication number
- CN113635306B CN113635306B CN202110963359.9A CN202110963359A CN113635306B CN 113635306 B CN113635306 B CN 113635306B CN 202110963359 A CN202110963359 A CN 202110963359A CN 113635306 B CN113635306 B CN 113635306B
- Authority
- CN
- China
- Prior art keywords
- joint
- robot
- zero
- emergency braking
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 44
- 230000001133 acceleration Effects 0.000 claims abstract description 24
- 230000001960 triggered effect Effects 0.000 claims abstract description 7
- 239000013598 vector Substances 0.000 claims description 11
- 238000004590 computer program Methods 0.000 claims description 3
- 230000008569 process Effects 0.000 description 11
- 230000001360 synchronised effect Effects 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
Images
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/1656—Programme controls characterised by programming, planning systems for manipulators
-
- 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/0004—Braking devices
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种机器人紧急制动方法、机器人及存储介质,所述方法包括:触发紧急制动时,获取机器人各关节轴的运动参数约束值及各关节轴的当前的角度值和运动参数;根据各关节轴的运动参数约束值及当前的运动参数,采用设定的加减速策略规划机器人各个关节轴减速至零的角度增量、时间及角速度曲线;根据规划的各个关节轴的角度增量判断是否存在关节超出限位;若不存在关节超出限位,则保持角度增量不变,将各个关节轴减速至零的时间中的最大值设定为其它各个关节轴减速至零的时间,重新规划其它各个关节轴减速至零的角速度曲线。采用本发明的技术方案,可以保证机器人各关节轴以最快的速度停止。
Description
技术领域
本发明涉及机器人控制领域,尤其涉及一种机器人紧急制动方法、机器人及存储介质。
背景技术
近年来,随着工业的发展,工业机器人的需求逐渐增加,对其安全性的要求也越来越高。当工业机器人正常运行过程中发生危害时,急停装置作为紧急制动的措施,可以通过人为按下急停按钮,使机器人的所有轴立即停止运动,有效终止危害。目前使机器人紧急停止的方式有两种:一是控制器不进行速度规划,伺服驱动器直接受控停止,但此种方式会给机器人带来较大的冲击和振动,缩短机器人寿命;二是通过控制器对机器人TCP(ToolCenter Point,工具中心点)线速度进行降速规划实现机器人停止,例如S型速度曲线,但该方式未考虑关节约束,从而不能充分发挥机器人关节的最佳性能,因此不能达到时间最优,且在机器人高速运动过程中,若速度曲线参数设置不合理,该方式会出现机器人抖动。
在中国专利申请CN112269348A中,提出了一种运动控制急停方法,但是该方法是针对触发急停时的笛卡尔线速度进行重新规划,且在计算过程中急停时间由自己设定,因此不能保证机器人各关节轴以最大的速度和加速度停止。
发明内容
本发明的目的是针对上述现有技术中机器人紧急制动过程中不能以最快的速度停止的技术问题,提供一种机器人紧急制动方法、机器人及存储介质。
本发明实施例中,提供了一种机器人紧急制动方法,其包括:
触发紧急制动时,获取机器人各关节轴的运动参数约束值及各关节轴的当前的角度值、运动参数;
根据各关节轴的运动参数约束值及当前的运动参数,采用设定的加减速策略规划机器人各个关节轴减速至零的角度增量、时间及角速度曲线;
根据规划的各个关节轴的角度增量判断是否存在关节超出限位;
若不存在关节超出限位,则保持角度增量不变,将各个关节轴减速至零的时间中的最大值设定为其它各个关节轴减速至零的时间,重新规划其它各个关节轴减速至零的角速度曲线。
本发明实施例中,若存在关节超出限位,则采用对机器人的TCP线速度进行规划的方式,来重新规划机器人各关节轴减速至零的角速度曲线。
本发明实施例中,所述各个关节轴的运动参数包括各关节的角速度值、角加速度值及角捷度值。
本发明实施例中,所述的机器人紧急制动方法,还包括:
控制机器人各关节轴按照重新规划的角速度曲线逐步减速到零。
本发明实施例中,根据各个关节轴的角度增量判断是否存在关节超出限位,包括:
计算各个关节轴减速至零时的角度值;
根据各个关节轴减速至零时的角度值来判断各个关节轴是否存在超过关节限位的情况。
本发明实施例中,计算各个关节轴减速至零时的角度值,包括:
根据起始点关节角度值和触发急停瞬时的各关节角度值来确定各个关节轴的方向向量;
采用如下公式计算各关节轴减速至零时的角度值,
本发明实施例中,设定的加减速策略为S型加减速策略、T型加减速策略或者sin型加减速策略。
本发明实施例中,重新规划其它各个关节轴减速至零的角速度曲线,包括:
分别计算其它各个关节轴减速至零的时间与各个关节轴减速至零所需要的时间中的最大值的比例系数Ki;
根据所述比例系数Ki对其它各个关节轴减速至零的角速度曲线的时间轴进行缩放,得到重新规划后的各个关节轴减速至零的角速度曲线。
本发明实施例中,还提供了一种机器人,当所述机器人发出紧急制动指令时,控制各个关节轴采用上述的机器人紧急制动方法进行制动。
本发明实施例中,一种存储介质,其存储有计算机程序,当所述计算机程序被运行时,执行上述的机器人紧急制动方法。
与现有技术相比较,在本发明的机器人紧急制动方法中, 急停触发时通过对各个关节轴进行单独规划,不需要以牺牲TCP末端速度的方式来防止机器人报错,能够充分发挥各关节轴性能,达到时间最优;在对关节规划时进行时间对齐,各关节轴的角速度曲线虽然单独规划,但能实现同起同停,保证了停止过程的协调性,在急停过程中不会出现抖动的现象。
附图说明
图1是本发明实施例的机器人紧急制动方法的流程图。
图2是本发明实施例的机器人紧急制动方法的制动参数曲线图。
图3是现有技术的机器人紧急制动方法的制动参数曲线图。
具体实施方式
本发明施例提供了一种机器人紧急制动方法,本发明实施例中,提供了一种机器人紧急制动方法,其包括步骤S1-S6。下面以具有6个关节轴的机器人为例,对上述步骤进行详细说明。
步骤S1:触发紧急制动时,获取各关节轴的运动参数约束值和机器人各关节轴的当前的角度值、运动参数。
本发明实施例中,所述各个关节轴的运动参数包括各关节的角速度值、角加速度值及角捷度值。设定各关节角度值为,各关节当前角速度值为,当前角加速度值为,当前角捷度值为,示例如下表:
各个关节轴的运动参数约束值即为各个运动参数的最大值,具体示例如下:
步骤S2:采用设定的加减速策略规划机器人各个关节轴减速至零的角度增量、时间及速度曲线。
需要说明的是,设定的加减速策略可以为S型加减速策略、T型加减速策略或者sin型加减速策略,不同的加减速策略对应不同的角速度曲线。基于设定的一种加减速策略,根据各关节轴的瞬时角速度值,瞬时角加速度值,瞬时角捷度值和各关节轴的运动参数约束值,即可得出各关节轴减速至零所需要的角度增量、最短时间及速度曲线。
步骤S3:根据规划的各个关节轴的角度增量判断是否存在关节超出限位,若不存在关节超出限位,则运行步骤S4,若存在关节超出限位,则运行步骤S5。
需要说明的是,在规划各个关节轴的角速度曲线时,并没有考虑到各个关节轴的角度增量是否超出限位,而每个关节轴存在一个最大的旋转角度,不可超出这个角度。因此,在获得各关节轴的角度增量后,需要据此来判断是否存在关节超出限位的情况。具体地,根据各个关节轴的角度增量判断是否存在关节超出限位,包括:
根据各个关节轴起始点的角度值和触发急停瞬时的各关节轴的角度值来确定各个关节轴的方向向量,具体地,若触发急停时的关节轴角度值大于关节轴起始点的角度值,则方向向量为正,否则为负;
步骤S4:保持规划的角度增量不变,将各个关节轴减速至零的时间中的最大值设定为其它各个关节轴减速至零的时间,重新规划其它各个关节轴减速至零的角速度曲线。
具体地,本步骤中,重新规划其它各个关节轴减速至零的过程中的角速度速度曲线,包括:
分别计算其它各个关节轴减速至零的时间与各个关节轴减速至零所需要的时间中的最大值的比例系数Ki;
根据所述比例系数Ki对其它各个关节轴减速至零的角速度曲线的时间轴进行缩放,得到重新规划后的各个关节轴减速至零的角速度曲线。
在上述过程中,也就是根据比例系数Ki对原先规划的其它各个关节轴的速度曲线进行缩放,使得减速时间同步。时间同步后,机器人各个关节轴的运动参数曲线如图2所示。图3是直接对机器人的TCP线速度进行规划,得到的机器人各关节的运动参数曲线。与图3相比较,可以看出,采用上述的机器人紧急制动方法机器人减速至零所需的时间更短,在充分发挥关节驱动性能的前提下,既保证了高速运行触发紧急停止过程中关节轴角加速度连续无突变,又确保了各关节轴运行时同起同停,实现了运动的协调性。
步骤S5:若存在关节超出限位,则采用对机器人的TCP线速度进行规划的方式来重新规划机器人各个关节的角速度曲线。
需要说明的是,由于在步骤S2规划的角速度曲线中,存在关节超出限位的情况,因此,若上述规划无法实施,只能采取现有技术的方式,对机器人的TCP线速度进行规划,来重新规划机器人各个关节的角速度曲线。
步骤S6:控制机器人各关节轴按照重新规划的角速度曲线逐步减速到零。
本发明实施例中,还提供了一种机器人,当所述机器人发出紧急制动指令时,控制各个关节轴采用上述的机器人紧急制动方法进行制动。
本发明实施例中,一种存储介质,其存储有计算机程序,当所述计算机程序被运行时,执行上述的机器人紧急制动方法。
综上所述,在本发明的机器人紧急制动方法中, 急停触发时通过对各个关节轴进行单独规划,不需要以牺牲TCP末端速度的方式来防止机器人报错,能够充分发挥各关节轴性能,达到时间最优;在对关节规划时进行时间对齐,各关节轴的角速度曲线虽然单独规划,但能实现同起同停,保证了停止过程的协调性,在急停过程中不会出现抖动的现象。
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。
Claims (10)
1.一种机器人紧急制动方法,其特征在于,包括:
触发紧急制动时,获取机器人各关节轴的运动参数约束值及各关节轴的当前的角度值和运动参数;
根据各关节轴的运动参数约束值及当前的运动参数,采用设定的加减速策略规划机器人各个关节轴减速至零的角度增量、时间及角速度曲线;
根据规划的各个关节轴的角度增量判断是否存在关节超出限位;
若不存在关节超出限位,则保持角度增量不变,将各个关节轴减速至零的时间中的最大值设定为其它各个关节轴减速至零的时间,重新规划其它各个关节轴减速至零的角速度曲线。
2.如权利要求1所述的机器人紧急制动方法,其特征在于,若存在关节超出限位,则采用对机器人的TCP线速度进行规划的方式,来重新规划机器人各关节轴减速至零的角速度曲线。
3.如权利要求1或2所述的机器人紧急制动方法,其特征在于,还包括:
控制机器人各关节轴按照重新规划的角速度曲线逐步减速到零。
4.如权利要求1所述的机器人紧急制动方法,其特征在于,所述各个关节轴的运动参数包括各关节的角速度值、角加速度值及角捷度值。
5.如权利要求1所述的机器人紧急制动方法,其特征在于,根据各个关节轴的角度增量判断是否存在关节超出限位,包括:
计算各个关节轴减速至零时的角度值;
根据各个关节轴减速至零时的角度值来判断各个关节轴是否存在超过关节限位的情况。
7.如权利要求1所述的机器人紧急制动方法,其特征在于,设定的加减速策略为S型加减速策略、T型加减速策略或者sin型加减速策略。
8.如权利要求1所述的机器人紧急制动方法,其特征在于,重新规划其它各个关节轴减速至零的角速度曲线,包括:
分别计算其它各个关节轴减速至零的时间与各个关节轴减速至零所需要的时间中的最大值的比例系数Ki;
根据所述比例系数Ki对其它各个关节轴减速至零的角速度曲线的时间轴进行缩放,得到重新规划后的各个关节轴减速至零的角速度曲线。
9.一种机器人,其特征在于,当所述机器人发出紧急制动指令时,控制各个关节轴采用如权利要求1-8任意一项所述的机器人紧急制动方法进行制动。
10.一种存储介质,其特征在于,存储有计算机程序,当所述计算机程序被运行时,执行如权利要求1-8任意一项所述的机器人紧急制动方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110963359.9A CN113635306B (zh) | 2021-08-20 | 2021-08-20 | 机器人紧急制动方法、机器人及存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110963359.9A CN113635306B (zh) | 2021-08-20 | 2021-08-20 | 机器人紧急制动方法、机器人及存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113635306A CN113635306A (zh) | 2021-11-12 |
CN113635306B true CN113635306B (zh) | 2022-11-11 |
Family
ID=78423277
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110963359.9A Active CN113635306B (zh) | 2021-08-20 | 2021-08-20 | 机器人紧急制动方法、机器人及存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113635306B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116494251A (zh) * | 2023-06-26 | 2023-07-28 | 佛山隆深机器人有限公司 | 机器人紧急制动方法、装置、设备及存储介质 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4705999A (en) * | 1984-04-27 | 1987-11-10 | Matsushita Electric Industrial Co., Ltd. | Method for controlling an articulated robot |
JP2018055395A (ja) * | 2016-09-29 | 2018-04-05 | ブラザー工業株式会社 | 数値制御装置と制御方法 |
CN111085995A (zh) * | 2019-12-13 | 2020-05-01 | 珠海格力电器股份有限公司 | 一种机器人速度规划方法、装置、存储介质及机器人 |
CN111775148A (zh) * | 2020-06-15 | 2020-10-16 | 珠海格力电器股份有限公司 | 一种机器人控制方法、装置、存储介质及机器人 |
CN111958600A (zh) * | 2020-08-19 | 2020-11-20 | 南京埃斯顿机器人工程有限公司 | 一种工业机器人停止过程段的振动抑制方法 |
CN112269348A (zh) * | 2020-10-14 | 2021-01-26 | 合肥泰禾光电科技股份有限公司 | 一种运动控制急停方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP3498433A1 (en) * | 2017-12-14 | 2019-06-19 | Universal Robots A/S | Dynamical safety trajectories in a robotic system |
CN109773778B (zh) * | 2018-12-09 | 2020-09-22 | 西安航天精密机电研究所 | 一种工业机器人关节空间同步运动的规划方法 |
-
2021
- 2021-08-20 CN CN202110963359.9A patent/CN113635306B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4705999A (en) * | 1984-04-27 | 1987-11-10 | Matsushita Electric Industrial Co., Ltd. | Method for controlling an articulated robot |
JP2018055395A (ja) * | 2016-09-29 | 2018-04-05 | ブラザー工業株式会社 | 数値制御装置と制御方法 |
CN111085995A (zh) * | 2019-12-13 | 2020-05-01 | 珠海格力电器股份有限公司 | 一种机器人速度规划方法、装置、存储介质及机器人 |
CN111775148A (zh) * | 2020-06-15 | 2020-10-16 | 珠海格力电器股份有限公司 | 一种机器人控制方法、装置、存储介质及机器人 |
CN111958600A (zh) * | 2020-08-19 | 2020-11-20 | 南京埃斯顿机器人工程有限公司 | 一种工业机器人停止过程段的振动抑制方法 |
CN112269348A (zh) * | 2020-10-14 | 2021-01-26 | 合肥泰禾光电科技股份有限公司 | 一种运动控制急停方法 |
Also Published As
Publication number | Publication date |
---|---|
CN113635306A (zh) | 2021-11-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP0191103B1 (en) | Method of controlling multi-joint robot | |
US10173318B2 (en) | Method and device for controlling a peripheral component of a robot system | |
JP5840288B2 (ja) | モータ制御装置 | |
US7842904B2 (en) | Welding system and consumable electrode welding method | |
US20110093120A1 (en) | Apparatus and method for adjusting parameter of impedance control | |
US20150174760A1 (en) | Method for adjusting robot control parameters, robot system, and robot controller | |
JPWO2005009692A1 (ja) | ロボットアームの制御方法および制御装置 | |
CN101799660B (zh) | 用于操纵器的控制设备和方法 | |
CN113635306B (zh) | 机器人紧急制动方法、机器人及存储介质 | |
US9827674B2 (en) | Method and manipulator assembly for the conditional stopping of at least one manipulator on a path | |
WO2007046257A1 (ja) | モータ制御装置及び方法及びプログラム記憶媒体 | |
JP5331068B2 (ja) | 数値制御装置 | |
CN112987568B (zh) | 并联加工机器人进给速度规划方法以及装置 | |
CN112713817A (zh) | 电动机的控制装置 | |
WO1997001801A1 (fr) | Procede de regulation des operations d'acceleration et de deceleration d'un robot | |
CN110989504A (zh) | 一种五轴加工进给速度的区间自适应规划方法 | |
US20190217469A1 (en) | Robot controller | |
JP3339642B2 (ja) | ロボットの加減速時定数決定方法 | |
CN112269348B (zh) | 一种运动控制急停方法 | |
JPH07210225A (ja) | 数値制御装置 | |
CN114260900B (zh) | 机器人的减速控制方法和装置、机器人组件和存储介质 | |
Sawodny et al. | Trajectory generation for the trajectory tracking control of a fire rescue turntable ladder | |
WO2024024578A1 (ja) | ロボットの制御方法及びロボットの制御装置 | |
JP2008253132A (ja) | サーボモータおよび多関節ロボットの異常負荷検出制御方法 | |
JP3243346B2 (ja) | クレーンの振れ止め制御の制御終了方法 |
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 |