CN107813345A - 机器人碰撞检测方法及装置 - Google Patents
机器人碰撞检测方法及装置 Download PDFInfo
- Publication number
- CN107813345A CN107813345A CN201711217374.9A CN201711217374A CN107813345A CN 107813345 A CN107813345 A CN 107813345A CN 201711217374 A CN201711217374 A CN 201711217374A CN 107813345 A CN107813345 A CN 107813345A
- Authority
- CN
- China
- Prior art keywords
- robot
- torque
- external observation
- target component
- collision
- 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
Classifications
-
- 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/0095—Means or methods for testing manipulators
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
本发明提供了一种机器人碰撞检测方法及装置,涉及工业机器人领域,上述的机器人碰撞检测方法,包括步骤:获取机器人的目标参数信息;根据目标参数信息获得机器人所受的外部观测力矩;当外部观测力矩的绝对值大于与目标参数信息对应的碰撞阈值时,则判定机器人将要发生碰撞,控制机器人停止运动。根据目标参数信息获得机器人所受的外部观测力矩,将外部观测力矩的绝对值和与目标参数信息对应的碰撞阈值相比较,根据比较结果控制机器人运动状态,以免发生碰撞,本发明无需传感器即可实现机器人碰撞检测。
Description
技术领域
本发明涉及工业机器人领域,特别是涉及一种机器人碰撞检测方法及装置。
背景技术
机器人因具有良好的人机协作性能,有广阔的应用前景。但机器人在作业过程中,常会与周围物体发声碰撞,造成机器人损伤和被撞物体损伤。为了避免因机器人与周围物体发生碰撞,需要提供一种碰撞检测方法。目前,常用的碰撞检测方法主要有基于路径规划的碰撞检测方法和基于力传感器的碰撞检测方法。
基于路径规划的碰撞检测方法,对环境要求苛刻,且随着基本元数量增加,计算量呈几何性增长,会导致碰撞检测效率下降、算法崩溃等问题;所以工程应用中多采用基于力传感器的碰撞检测方法。
但发明人在实现过程中发现,基于力传感器的碰撞检测方法需要额外增加传感器,增加了碰撞检测成本,而且需要改变机器人的结构,操作较为不便。
发明内容
基于此,有必要针对机器人碰撞检测需要额外增加传感器造成的操作不方便问题,提供一种机器人碰撞检测方法及装置。
本发明实施例,一方面提供了一种机器人碰撞检测方法,包括步骤:
获取机器人的目标参数信息;
根据所述目标参数信息获得机器人所受的外部观测力矩;
当所述外部观测力矩的绝对值大于与所述目标参数信息对应的碰撞阈值时,则判定所述机器人将要发生碰撞,控制机器人停止运动。
在其中一个实施例中,所述目标参数信息包括输出力矩相关信息、摩擦力矩相关信息和外部观测力矩相关信息;
根据所述目标参数信息获得机器人所受的外部观测力矩的步骤包括:
根据所述输出力矩相关信息,获得机器人各关节电机的输出力矩;
向预先建立的摩擦模型中输入所述摩擦力矩相关信息,获得机器人各关节所受摩擦力矩;
根据所述外部观测力矩相关信息、所述输出力矩和所述摩擦力矩,获得机器人所受外部观测力矩。
在其中一个实施例中,所述根据所述输出力矩相关信息,获得机器人各关节电机的输出力矩的步骤包括:
向预先建立的各关节电机的动力学模型中输入所述输出力矩相关信息,获得所述机器人各关节电机的输出力矩。
在其中一个实施例中,所述根据所述外部观测力矩相关信息、所述输出力矩和所述摩擦力矩,获得机器人所受外部观测力矩的步骤包括:
向预先建立的外部力矩观测器中输入所述外部观测力矩相关信息、所述输出力矩和所述摩擦力矩,获得所述机器人所受外部观测力矩。
在其中一个实施例中,在所述当所述外部观测力矩的绝对值大于与所述目标参数对应的碰撞阈值时,则判定所述机器人将要发生碰撞,控制机器人停止运动的过程之前还包括步骤:
对所述外部观测力矩进行抗干扰处理。
在其中一个实施例中,所述摩擦力矩相关信息包括关节转角角速度;
所述碰撞阈值与所述关节转角角速度之间呈函数关系;当所述关节转角角速度的绝对值大于等于预设的关节角速度阈值时,所述碰撞阈值为第一预设值,当所述关节转角角速度的绝对值小于预设的关节角速度阈值时,所述碰撞阈值随着所述关节转角角速度的绝对值的减小而增大。
一种机器人碰撞检测装置,包括:
参数获取单元,用于获取机器人的目标参数信息;
外部观测力矩获取单元,用于根据所述目标参数信息获得机器人所受的外部观测力矩;
控制单元,用于当所述外部观测力矩的绝对值大于与所述目标参数信息对应的碰撞阈值时,则判定所述机器人将要发生碰撞,控制机器人停止运动。
一种机器人,包括运动机构、信息采集装置、控制装置;
所述信息采集装置用于获取机器人的目标参数信息并发送给所述控制装置;
所述控制装置用于根据所述目标参数信息获得机器人所受的外部观测力矩,并在所述外部观测力矩的绝对值大于与所述目标参数信息对应的碰撞阈值时,控制所述运动机构停止运动。
一种计算机设备,包括存储器、处理器,所述存储器上存储有可在所述处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现上述机器人碰撞检测方法。
一种计算机可读存储介质,其上存储有计算机程序,该程序被处理器执行时实现上述机器人碰撞检测方法。
本发明实施例通过对机器人各目标参数信息的采集,获取机器人各关节所受外部观测力矩,将外部观测力矩与设定的动态阈值进行比较,当外部观测力矩大于设定的动态阈值时,则判定所述机器人将要发生碰撞,控制机器人停止运动;本发明实施例根据目标参数获得外部观测力矩,无需增加外部传感器即可实现对机器人的碰撞检测,降低检测成本,方便操作。
附图说明
图1为本发明机器人碰撞检测方法实施例的第一流程示意图;
图2为本发明机器人碰撞检测方法实施例的第二流程示意图;
图3为本发明机器人碰撞检测方法实施例中碰撞阈值第一示意图;
图4为本发明机器人碰撞检测方法实施例中碰撞阈值第二示意图;
图5为本发明机器人碰撞检测方法实施例的第三流程示意图;
图6为本发明机器人碰撞检测方法实施例的第四流程示意图;
图7为本发明机器人碰撞检测装置实施例的第一结构示意图;
图8为本发明机器人碰撞检测装置实施例的第二结构示意图;
图9为本发明机器人实施例的结构示意图。
具体实施方式
为使本发明的上述目的、特征和优点能够更加明显易懂,下面结合附图对本发明的具体实施方式做详细的说明。在下面的描述中阐述了很多具体细节以便于充分理解本发明。但是本发明能够以很多不同于在此描述的其它方式来实施,本领域技术人员可以在不违背本发明内涵的情况下做类似改进,因此本发明不受下面公开的具体实施的限制。
除非另有定义,本说明书实施例中所使用的所有的技术和科学术语与属于本发明的技术领域的技术人员通常理解的含义相同。本说明书实施例中在本发明的说明书中所使用的术语只是为了描述具体的实施例的目的,不是旨在于限制本发明。本说明书实施例中所使用的术语“及/或”包括一个或多个相关的所列项目的任意的和所有的组合。
参见图1,为本发明机器人碰撞检测方法的实施例的流程示意图,机器人碰撞检测方法包括:
S1:获取机器人的目标参数信息。
S3:根据目标参数信息获得机器人所受的外部观测力矩。
其中,目标参数信息是指进行碰撞检测时需要的参数信息,因为碰撞检测是实时检测,所以目标参数信息应当理解为机器人当前的各参数信息。例如,目标参数信息可以包括机器人各关节运动的角度、角速度、输出电流信息等,还可以包括驱动器信号信息等,还可以包括机器人本身的额定性能参数,如机器人电机端转子额定转动惯量等,上述目标参数信息均可通过机器人参数辨识方法得到,无需外部传感器。需要说明的是,目标参数信息可以包括上述类型的目标参数信息,但不限于上述类型的目标参数信息,一切为解决本发明技术问题所要用到的参数均属于上述目标参数信息的范畴。
在其中一个实施例中,参见图2,目标参数信息包括输出力矩相关信息、摩擦力矩相关信息和外部观测力矩相关信息;根据目标参数信息获得机器人所受的外部观测力矩的步骤包括:
S31:根据输出力矩相关信息,获得机器人各关节电机的输出力矩。
其中,输出力矩相关信息指与机器人各关节电机的输出力矩相关的参数。
在其中一个实施例中,输出力矩相关信息包括驱动器信号。根据输出力矩相关信息,获得机器人各关节电机的输出力矩的步骤可以包括:根据驱动器信号直接获取机器人各关节电机的输出力矩。
具体的,先采集驱动器信号,将驱动器信号转换为可识别的数据信息,从转换后的数据信息中提取当前各关节电机的输出力矩。
在其中一个实施例中,根据输出力矩相关信息,获得机器人各关节电机的输出力矩的步骤包括:
向预先建立的各关节电机的动力学模型中输入所述输出力矩相关信息,获得所述机器人各关节电机的输出力矩。
其中,预先建立的各关节电机的动力学模型是根据动力学原理建立的关于输出力矩相关信息的方程式。具体的,向预先建立的各关节电机的动力学模型中输入输出力矩相关信息,可以是机器人内部的处理模块根据各关节电机的动力学模型求解得出机器人各关节电机的输出力矩。
可选的,输出力矩相关信息可以包括:τe、ia、KT、Jm、Bm、和其中τe为电机的磁场力矩,KT为电磁力矩常数,Jm为电机端转子额度转动惯量,Bm为阻尼常数,分别为电机转子的角速度与角加速度。
预先建立的各关节电机的动力学模型可以是:
其中,τm为各关节电机的输出力矩,τe可以通过驱动器信号直接获取或通过电枢电流ia计算获取,通过电枢电流ia计算获取的过程可以是:通过获取电机编码器的返回值获得电机转子的角速度和角加速度并采集电机的电枢电流ia,根据动力学方程τe=KTia计算得到τe,将τe代入到动力学方程中,计算当前各关节电机的输出力矩τm。
S32:向预先建立的摩擦模型中输入所述摩擦力矩相关信息,获得机器人各关节所受摩擦力矩。
其中,摩擦力矩相关信息是指与机器人各关节所受摩擦力矩相关的参数。预先建立的摩擦模型,是根据应用场景等预先设置的摩擦模型,可以是关于摩擦力矩相关信息的方程式,将获取的摩擦力矩相关信息代入摩擦模型,可以获得机器人各关节所受摩擦力矩。
具体的,选取合适的摩擦模型,并结合机器人工作原理,预先建立摩擦模型,摩擦模型反应各关节在运动过程中所受摩擦力与关节转角角速度等参数的关系。将摩擦力矩相关信息代入预先建立的摩擦模型,获得各关节所受摩擦力矩。
在低速状态下,摩擦环节等对***影响较大,较大的静摩擦力容易导致误检测产生,本发明实施例考虑摩擦力对机器人运动过程中碰撞检测的影响,通过建立摩擦模型,求取当前各关节所受摩擦力矩,精准判断机器人当前关节所受力矩的情况,为准确地进行碰撞检测提供数据依据。
在其中一个实施例中,摩擦力矩相关信息包括z、σ0、σ1、σ2、Fc、FS、λ、其中,f为各关节所受摩擦力矩。z为接触面鬃毛的平均变形量,σ0为摩擦刚性系数,σ1为摩擦阻尼系数,σ2为黏性摩擦系数,Fc为库伦摩擦力矩,FS为最大静摩擦力矩,为Stribeck速度,λ为摩擦系数,关节转角角速度。
预先建立的摩擦模型可以是:
其中,Stribeck速度为通过采集运动过程中的机器人的关节位置信息和实际力矩值进行数据处理得到的。具体的,建立当前各关节所受摩擦力矩f的LuGre摩擦模型,根据获取的目标参数信息,获取每个参数的值,将已知参数代入到LuGre摩擦模型中,计算得到f。
本实施例选用的LuGre摩擦模型涵盖库伦摩擦、预滑动和摩擦滞后等现象,与真实的摩擦现象更为接近,能够更加真实的反应机器人当前各关节所受摩擦力矩大小,以便更准确进行机器人碰撞检测。
需要说明的是,还可以根据其他动态摩擦力模型,计算当前各关节所受摩擦力矩f。例如,可以根据Dahl、Leuven等模型计算摩擦力矩f。
S33:根据所述外部观测力矩相关信息、所述输出力矩和所述摩擦力矩,获得机器人所受外部观测力矩。
其中,外部观测力矩相关信息,是指与机器人所受外部观测力矩有关的参数,根据外部观测力矩相关信息可以得到机器人所受外部观测力矩。
在其中一个实施例中,所述根据所述外部观测力矩相关信息、所述输出力矩和所述摩擦力矩,获得机器人所受外部观测力矩的步骤包括:
向预先建立的外部力矩观测器中输入所述外部观测力矩相关信息、所述输出力矩和所述摩擦力矩,获得所述机器人所受外部观测力矩。
其中,预先建立的外部力矩观测器可以是根据动能守恒定理及机器人动力学原理建立的,可以是关于外部观测力矩相关信息、输出力矩和摩擦力矩的方程式。
在其中一个实施例中,外部观测力矩相关信息包括:N、τ、M(q)、G(q)、、τext、q,其中,τext为所受外部观测力矩N为机器人的减速比,τ为机器人关节所受的控制力矩,M(q)为机器人的惯量矩阵,为哥氏力与离心力向量,G(q)为重力矩;q为关节转角;
预先建立的外部力矩观测器的建立过程可以包括:
建立关于外部观测力矩相关信息、输出力矩和摩擦力矩的机器人动力学模型:
根据机器人动力学模型,建立外部力矩观测器:
其中,为外部力矩观测器,K1、K2均为***增益矩阵且为正定矩阵;p为***动量,M(q)惯量矩阵通过机器人参数辨识获得。
可选的,根据机器人动力学模型,预先建立的外部力矩观测器还可以是:
其中,K3为***增益矩阵。
将获取的外部观测力矩相关信息、输出力矩τm和摩擦力矩f代入到预先建立的外部力矩观测器中,得到外部观测力矩τext。
S5:当所述外部观测力矩的绝对值大于与所述目标参数信息对应的碰撞阈值时,则判定所述机器人将要发生碰撞,控制机器人停止运动。
其中,碰撞阈值是根据机器人的应用场景所设,随着机器人关节角速度的绝对值的减小,碰撞阈值整体呈增大趋势。如,当机器人关节角速度较低时,设置较大的碰撞阈值,当机器人关节角速度超过一定的关节角速度阈值时,可以设置某个较低的恒定的碰撞阈值,通过设置碰撞阈值,避免机器人低速作业时发生漏检情况,其中关节角速度阈值是经过实验得出的。
具体的,将获得的外部观测力矩的绝对值和与所述目标参数信息对应的碰撞阈值进行比较,若外部观测力矩的绝对值大于与所述目标参数对应的碰撞阈值,则控制机器人停止运动。例如,可以是当检测到外部观测力矩的绝对值大于与所述目标参数对应的碰撞阈值,此时判定机器人即将发生碰撞,发送停止运动命令给控制装置,控制装置根据接收到的停止运动命令控制机器人停止运动,防止发生碰撞,造成机器人损伤或被撞物体损伤。
在其中一个实施例中,所述摩擦力矩相关信息包括关节转角角速度;
所述碰撞阈值与所述关节转角角速度之间呈函数关系;当所述关节转角角速度的绝对值大于预设的关节角速度阈值时,所述碰撞阈值为第一预设值,当所述关节转角角速度的绝对值小于预设的关节角速度阈值时,所述碰撞阈值随着所述关节转角角速度的绝对值的减小而增大。
其中,关节角速度阈值、第一预设值是根据应用场景设定的值,是经过实验得出的。具体的,碰撞阈值与关节转角角速度的绝对值之间的关系可以是:当所述关节转角角速度的绝对值大于预设的关节角速度阈值时,所述碰撞阈值为第一预设值,当关节转角角速度的绝对值小于关节角速度阈值时,碰撞阈值由第一预设值开始随着关节转角角速度的绝对值的减小而增大。可选的,当关节转角角速度趋近于0时,碰撞阈值收敛于第二预设值,其中,第二预设值大于第一预设值。
在其中一个实施例中,参见图3,关于第一预设值和第二预设值的碰撞阈值选取模型可以是:
其中,τa、τb是根据应用场景要求预设的,τa为第二预设值,τb为第一预设值,ωs为预设的关节角速度阈值;
根据关节转角角速度的绝对值与关节角速度阈值ωs的大小关系,可以获得与目标参数对应的碰撞阈值。
在其中一个实施例中,如图4所示,关于第一预设值和第二预设值的碰撞阈值选取模型还可以是:
其中,τa、τb为根据应用场景要求预设的临界阈值,ωs为预设的关节角速度阈值;
根据关节转角角速度的绝对值与关节角速度阈值ωs的大小关系,获得碰撞阈值。
可选的,碰撞阈值选取模型还可以是根据高阶函数方法,建立的关于关节角速度阈值的碰撞阈值选取模型,并根据关节转角角速度的绝对值与关节角速度阈值ωs的大小关系,设定动态阈值。
本发明实施例考虑到,当关节转速较慢时,***受摩擦、齿隙等影响较大,随着关节转速提升,摩擦力矩转为动摩擦,齿隙影响削弱,设定碰撞阈值,当关节转速较慢时,设定较大的碰撞阈值,当关节转速提升到较快速度时,设定较小的碰撞阈值,以避免低速状态下碰撞检测时的误检情况的发生,减小误检测率。
在其中一个实施例中,参见图5和图6,在根据目标参数信息获得机器人所受的外部观测力矩的过程之前,还包括步骤:
S2:对目标参数信息进行抗干扰处理。
其中,抗干扰处理的方式有很多,可选的,通过对获取的目标参数信息进行滤波处理,将进行滤波处理后的目标参数信息作为碰撞检测的数据依据。例如,机器人中的数据采集模块采集目标参数信息,并将采集的目标参数信息发送给机器人中的处理器,处理器接收目标参数信息后,对目标参数信息进行滤波,并将滤波后的目标参数信息作为碰撞检测过程中的数据依据。
在其中一个实施例中,参见图5和图6,在所述当所述外部观测力矩的绝对值大于与所述目标参数对应的碰撞阈值时,则判定所述机器人将要发生碰撞,控制机器人停止运动的过程之前还包括步骤:
S4:对所述外部观测力矩进行抗干扰处理。
因机器人在采集目标参数信息时可能存在高频采样噪声,会影响外部观测力矩的值,造成***误检,所以要对外部观测力矩进行抗干扰处理,避免因其他采样噪声影响碰撞检测的准确性,降低碰撞检测误检率。可选的,可以通过对外部观测力矩进行低通滤波处理。
具体的,目标参数信息与上述目标参数信息释义相同,在此不做赘述。
参见图7,为本发明机器人碰撞检测装置实施例的结构示意图,机器人碰撞检测装置,包括:
参数获取单元710,用于获取机器人的目标参数信息;
外部观测力矩获取单元730,用于根据目标参数信息获得机器人所受的外部观测力矩;
控制单元750,用于当外部观测力矩的绝对值大于与所述目标参数对应的碰撞阈值时,则判定所述机器人将要发生碰撞,控制机器人停止运动。
具体的,参数获取单元710获取机器人的目标信息,可选的,可以是根据机器人参数识别方式或直接从驱动器获取的方式获取目标信息,将获取到的目标参数信息发送给外部观测力矩获取单元730,外部观测力矩获取单元730根据目标参数信息获得机器人所受的外部观测力矩,可以是预先建立外部观测力矩观测器,外部观测力矩获取单元730向预先建立外部观测力矩观测器中输入目标参数信息,以获得机器人所受的外部观测力矩;外部观测力矩获取单元730将获得的外部观测力矩发送给控制单元750,控制单元750将外部观测力矩的绝对值和与所述目标参数对应的碰撞阈值进行比较,当外部观测力矩的绝对值大于与所述目标参数对应的碰撞阈值时,则判定所述机器人将要发生碰撞,控制单元750控制机器人停止运动。
在其中一个实施例中,参见图8,目标参数信息包括输出力矩相关信息、摩擦力矩相关信息和外部观测力矩相关信息;
外部观测力矩获取单元包括:
第一处理单元731,用于根据输出力矩相关信息,获得机器人各关节电机的输出力矩;
第二处理单元732,用于向预先建立的摩擦模型中输入摩擦力矩相关信息,获得机器人各关节所受摩擦力矩;
第三处理单元733,用于根据外部观测力矩相关信息、输出力矩和摩擦力矩,获得机器人所受外部观测力矩。
在其中一个实施例中,参见图8,机器人碰撞检测装置还包括:
第一滤波单元720,用于对目标参数信息进行滤波。
在其中一个实施例中,参见图8,机器人碰撞检测装置还包括:
第二滤波单元740,用于对外部观测力矩进行滤波处理。
需要说明的是,上述机器人的各单元模块,能够对应实现上述机器人碰撞检测方法实施例中对应的流程步骤,以及在对应的机器人碰撞检测方法实施例中对各个名词的解释也适用于装置的实施例,此处不再重复赘述。
本发明实施例还提供一种机器人,如图9所示,上述机器人包括运动机构920、信息采集装置940、控制装置960;
信息采集装置940用于获取机器人的目标参数信息并发送给所述控制装置960;
所述控制装置960用于根据所述目标参数信息获得机器人所受的外部观测力矩,并在所述外部观测力矩的绝对值大于与所述目标参数信息对应的碰撞阈值时,控制所述运动机构停止运动。
具体的,信息采集装置940获取机器人的目标参数信息并发送给所述控制装置960,控制装置960根据接收的目标参数信息获得外部观测力矩,获得外部观测力矩的方法与上述机器人碰撞检测方法中的实施方式相同,在此不做赘述,控制装置960判断外部观测力矩的绝对值是否大于预设的与目标参数对应的碰撞阈值,若大于,则认为机器人将要发生碰撞,控制装置960控制机器人的运动机构920停止运动。
需要说明的是,机器人实施例中各组成部分的具体功能实现方式,可以与上述机器人碰撞检测方法中的相同,在此不予多加赘述。
本发明实施例还提供一种计算机设备,包括存储器、处理器,存储器上存储有可在处理器上运行的计算机程序,处理器执行计算机程序时实现上述的机器人碰撞检测方法。
一种计算机可读存储介质,其上存储有计算机程序,该程序被处理器执行时实现上述机器人碰撞检测方法实施例中的方法步骤。
以上实施例的各技术特征可以进行任意的组合,为使描述简洁,未对上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。此外,通常存储在一个存储介质中的程序通过直接将程序读取出存储介质或者通过将程序安装或复制到数据处理设备的存储设备(如硬盘和或内存)中执行。因此,这样的存储介质也构成了本发明。存储介质可以使用任何类型的记录方式,例如纸张存储介质(如纸带等)、磁存储介质(如软盘、硬盘、闪存等)、光存储介质(如CD-ROM等)、磁光存储介质(如MO等)等。
以上实施例仅表达了本发明的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对本发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进,这些都属于本发明的保护范围。因此,本发明专利的保护范围应以所附权利要求为准。
Claims (10)
1.一种机器人碰撞检测方法,其特征在于,包括步骤:
获取机器人的目标参数信息;
根据所述目标参数信息获得机器人所受的外部观测力矩;
当所述外部观测力矩的绝对值大于与所述目标参数信息对应的碰撞阈值时,则判定所述机器人将要发生碰撞,控制机器人停止运动。
2.根据权利要求1所述的机器人碰撞检测方法,其特征在于,所述目标参数信息包括输出力矩相关信息、摩擦力矩相关信息和外部观测力矩相关信息;
根据所述目标参数信息获得机器人所受的外部观测力矩的步骤包括:
根据所述输出力矩相关信息,获得机器人各关节电机的输出力矩;
向预先建立的摩擦模型中输入所述摩擦力矩相关信息,获得机器人各关节所受摩擦力矩;
根据所述外部观测力矩相关信息、所述输出力矩和所述摩擦力矩,获得机器人所受外部观测力矩。
3.根据权利要求2所述的机器人碰撞检测方法,其特征在于,所述根据所述输出力矩相关信息,获得机器人各关节电机的输出力矩的步骤包括:
向预先建立的各关节电机的动力学模型中输入所述输出力矩相关信息,获得所述机器人各关节电机的输出力矩。
4.根据权利要求2或3中所述的机器人碰撞检测方法,其特征在于,所述根据所述外部观测力矩相关信息、所述输出力矩和所述摩擦力矩,获得机器人所受外部观测力矩的步骤包括:
向预先建立的外部力矩观测器中输入所述外部观测力矩相关信息、所述输出力矩和所述摩擦力矩,获得所述机器人所受外部观测力矩。
5.根据权利要求4所述的机器人碰撞检测方法,其特征在于,在所述当所述外部观测力矩的绝对值大于与所述目标参数对应的碰撞阈值时,则判定所述机器人将要发生碰撞,控制机器人停止运动的过程之前还包括步骤:
对所述外部观测力矩进行抗干扰处理。
6.根据权利要求5所述的机器人碰撞检测方法,其特征在于,所述摩擦力矩相关信息包括关节转角角速度;
所述碰撞阈值与所述关节转角角速度之间呈函数关系;当所述关节转角角速度的绝对值大于等于预设的关节角速度阈值时,所述碰撞阈值为第一预设值,当所述关节转角角速度的绝对值小于预设的关节角速度阈值时,所述碰撞阈值随着所述关节转角角速度的绝对值的减小而增大。
7.一种机器人碰撞检测装置,其特征在于,包括:
参数获取单元,用于获取机器人的目标参数信息;
外部观测力矩获取单元,用于根据所述目标参数信息获得机器人所受的外部观测力矩;
控制单元,用于当所述外部观测力矩的绝对值大于与所述目标参数信息对应的碰撞阈值时,则判定所述机器人将要发生碰撞,控制机器人停止运动。
8.一种机器人,其特征在于,包括运动机构、信息采集装置、控制装置;
所述信息采集装置用于获取机器人的目标参数信息并发送给所述控制装置;
所述控制装置用于根据所述目标参数信息获得机器人所受的外部观测力矩,并在所述外部观测力矩的绝对值大于与所述目标参数信息对应的碰撞阈值时,控制所述运动机构停止运动。
9.一种计算机设备,其特征在于,包括存储器、处理器,所述存储器上存储有可在所述处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现如权利要求1-6中任意一项所述的机器人碰撞检测方法。
10.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,该程序被处理器执行时实现权利要求1-6中任意一种机器人碰撞检测方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711217374.9A CN107813345B (zh) | 2017-11-28 | 2017-11-28 | 机器人碰撞检测方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711217374.9A CN107813345B (zh) | 2017-11-28 | 2017-11-28 | 机器人碰撞检测方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107813345A true CN107813345A (zh) | 2018-03-20 |
CN107813345B CN107813345B (zh) | 2020-11-13 |
Family
ID=61609277
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711217374.9A Active CN107813345B (zh) | 2017-11-28 | 2017-11-28 | 机器人碰撞检测方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107813345B (zh) |
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108748158A (zh) * | 2018-06-12 | 2018-11-06 | 上海节卡机器人科技有限公司 | 协作机器人、碰撞检测***和方法、存储介质、操作*** |
CN109079800A (zh) * | 2018-10-29 | 2018-12-25 | 珠海格力智能装备有限公司 | 机器人碰撞检测方法、装置、存储介质、处理器及机器人 |
CN109732599A (zh) * | 2018-12-29 | 2019-05-10 | 深圳市越疆科技有限公司 | 一种机器人碰撞检测方法、装置、存储介质及机器人 |
CN110103222A (zh) * | 2019-05-24 | 2019-08-09 | 北京无线电测量研究所 | 一种工业机器人碰撞检测方法 |
CN110340885A (zh) * | 2019-05-21 | 2019-10-18 | 南京航空航天大学 | 一种基于能量偏差观测器的工业机器人碰撞检测方法 |
CN110774317A (zh) * | 2019-11-26 | 2020-02-11 | 上海节卡机器人科技有限公司 | 线性关系模型的建立及碰撞检测方法、装置及电子设备 |
CN111113488A (zh) * | 2019-12-30 | 2020-05-08 | 南京埃斯顿自动化股份有限公司 | 一种机器人碰撞检测装置及碰撞检测的方法 |
WO2020147078A1 (zh) * | 2019-01-17 | 2020-07-23 | 西门子股份公司 | 机器人碰撞检测***和方法及包括该***的机器人 |
CN112092015A (zh) * | 2020-09-10 | 2020-12-18 | 中科新松有限公司 | 机器人碰撞检测测试方法 |
CN112405524A (zh) * | 2020-10-20 | 2021-02-26 | 深圳拓邦股份有限公司 | 机器人碰撞检测方法、装置及机器人 |
CN112486080A (zh) * | 2019-09-12 | 2021-03-12 | 苏州宝时得电动工具有限公司 | 一种户外机器人及其控制方法 |
CN112757345A (zh) * | 2021-01-27 | 2021-05-07 | 上海节卡机器人科技有限公司 | 一种协作机器人碰撞检测方法、装置、介质及电子设备 |
CN113319853A (zh) * | 2021-06-18 | 2021-08-31 | 广东智源机器人科技有限公司 | 机器人控制方法、装置、电子设备以及机器人*** |
CN114012734A (zh) * | 2021-12-03 | 2022-02-08 | 西安交通大学 | 一种参数自适应的机器人碰撞检测方法 |
CN114594757A (zh) * | 2020-12-07 | 2022-06-07 | 山东新松工业软件研究院股份有限公司 | 一种协作机器人的视觉路径规划方法 |
CN115107009A (zh) * | 2021-12-23 | 2022-09-27 | 沈阳新松机器人自动化股份有限公司 | 一种洁净机器人碰撞保护智能控制方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104985598A (zh) * | 2015-06-24 | 2015-10-21 | 南京埃斯顿机器人工程有限公司 | 一种工业机器人碰撞检测方法 |
CN105313118A (zh) * | 2014-07-09 | 2016-02-10 | 发那科株式会社 | 防止碰撞判定部的误判定的机器人控制装置 |
CN106426174A (zh) * | 2016-11-05 | 2017-02-22 | 上海大学 | 一种基于力矩观测和摩擦辨识的机器人接触力检测方法 |
-
2017
- 2017-11-28 CN CN201711217374.9A patent/CN107813345B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105313118A (zh) * | 2014-07-09 | 2016-02-10 | 发那科株式会社 | 防止碰撞判定部的误判定的机器人控制装置 |
CN104985598A (zh) * | 2015-06-24 | 2015-10-21 | 南京埃斯顿机器人工程有限公司 | 一种工业机器人碰撞检测方法 |
CN106426174A (zh) * | 2016-11-05 | 2017-02-22 | 上海大学 | 一种基于力矩观测和摩擦辨识的机器人接触力检测方法 |
Cited By (21)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108748158A (zh) * | 2018-06-12 | 2018-11-06 | 上海节卡机器人科技有限公司 | 协作机器人、碰撞检测***和方法、存储介质、操作*** |
CN109079800A (zh) * | 2018-10-29 | 2018-12-25 | 珠海格力智能装备有限公司 | 机器人碰撞检测方法、装置、存储介质、处理器及机器人 |
CN109732599A (zh) * | 2018-12-29 | 2019-05-10 | 深圳市越疆科技有限公司 | 一种机器人碰撞检测方法、装置、存储介质及机器人 |
CN109732599B (zh) * | 2018-12-29 | 2020-11-03 | 深圳市越疆科技有限公司 | 一种机器人碰撞检测方法、装置、存储介质及机器人 |
WO2020147078A1 (zh) * | 2019-01-17 | 2020-07-23 | 西门子股份公司 | 机器人碰撞检测***和方法及包括该***的机器人 |
CN110340885A (zh) * | 2019-05-21 | 2019-10-18 | 南京航空航天大学 | 一种基于能量偏差观测器的工业机器人碰撞检测方法 |
CN110340885B (zh) * | 2019-05-21 | 2021-12-07 | 南京航空航天大学 | 一种基于能量偏差观测器的工业机器人碰撞检测方法 |
CN110103222A (zh) * | 2019-05-24 | 2019-08-09 | 北京无线电测量研究所 | 一种工业机器人碰撞检测方法 |
CN112486080A (zh) * | 2019-09-12 | 2021-03-12 | 苏州宝时得电动工具有限公司 | 一种户外机器人及其控制方法 |
CN110774317A (zh) * | 2019-11-26 | 2020-02-11 | 上海节卡机器人科技有限公司 | 线性关系模型的建立及碰撞检测方法、装置及电子设备 |
CN111113488A (zh) * | 2019-12-30 | 2020-05-08 | 南京埃斯顿自动化股份有限公司 | 一种机器人碰撞检测装置及碰撞检测的方法 |
CN111113488B (zh) * | 2019-12-30 | 2022-06-14 | 南京埃斯顿自动化股份有限公司 | 一种机器人碰撞检测装置及碰撞检测的方法 |
CN112092015A (zh) * | 2020-09-10 | 2020-12-18 | 中科新松有限公司 | 机器人碰撞检测测试方法 |
CN112405524A (zh) * | 2020-10-20 | 2021-02-26 | 深圳拓邦股份有限公司 | 机器人碰撞检测方法、装置及机器人 |
CN112405524B (zh) * | 2020-10-20 | 2022-11-11 | 深圳拓邦股份有限公司 | 机器人碰撞检测方法、装置及机器人 |
CN114594757A (zh) * | 2020-12-07 | 2022-06-07 | 山东新松工业软件研究院股份有限公司 | 一种协作机器人的视觉路径规划方法 |
CN112757345A (zh) * | 2021-01-27 | 2021-05-07 | 上海节卡机器人科技有限公司 | 一种协作机器人碰撞检测方法、装置、介质及电子设备 |
CN113319853A (zh) * | 2021-06-18 | 2021-08-31 | 广东智源机器人科技有限公司 | 机器人控制方法、装置、电子设备以及机器人*** |
CN114012734A (zh) * | 2021-12-03 | 2022-02-08 | 西安交通大学 | 一种参数自适应的机器人碰撞检测方法 |
CN114012734B (zh) * | 2021-12-03 | 2023-05-30 | 西安交通大学 | 一种参数自适应的机器人碰撞检测方法 |
CN115107009A (zh) * | 2021-12-23 | 2022-09-27 | 沈阳新松机器人自动化股份有限公司 | 一种洁净机器人碰撞保护智能控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN107813345B (zh) | 2020-11-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107813345A (zh) | 机器人碰撞检测方法及装置 | |
CN104985598B (zh) | 一种工业机器人碰撞检测方法 | |
CN108772838A (zh) | 一种基于外力观测器的机械臂安全碰撞策略 | |
CN107253196B (zh) | 一种机械臂碰撞检测方法、装置、设备及存储介质 | |
CN108015774B (zh) | 一种无需传感器的机械臂碰撞检测方法 | |
CN106346513B (zh) | 一种六自由度机器人末端负载动力学参数辨识装置及方法 | |
CN106569487B (zh) | 一种基于观测器的伺服***的故障检测方法 | |
CN107263467B (zh) | 控制机器人转动关节运动的方法和装置及机器人 | |
CN104639003B (zh) | 一种交流伺服***的转动惯量辨识方法 | |
CN103878791B (zh) | 工业机器人无外部传感器的外力检测方法 | |
CN106426174A (zh) | 一种基于力矩观测和摩擦辨识的机器人接触力检测方法 | |
CN108000521A (zh) | 一种无传感器式协作机器人碰撞检测方法 | |
CN102608351B (zh) | 机械臂三维姿态的检测方法和***、及控制其运行的*** | |
CN113681543B (zh) | 一种基于模型预测的机械臂零力控制方法 | |
CN105945979B (zh) | 对欠驱动二指爪机构进行柔顺控制的方法 | |
Tomić et al. | Simultaneous estimation of aerodynamic and contact forces in flying robots: Applications to metric wind estimation and collision detection | |
CN110666794B (zh) | 一种机器人末端工具负载力和力矩补偿的方法 | |
CN112809667B (zh) | 工业机器人的力控制方法、装置及其应用 | |
CN110103222A (zh) | 一种工业机器人碰撞检测方法 | |
CN108638070A (zh) | 基于动态平衡的机器人负载重力参数辨识方法 | |
CN110682290B (zh) | 一种基于动量观测器的闭环机械臂***碰撞检测方法 | |
CN110026981A (zh) | 一种基于模型自适应的机械臂碰撞检测方法 | |
CN114603599A (zh) | 一种机器人碰撞检测方法、装置、计算机设备及存储介质 | |
JP3933158B2 (ja) | ロボットの衝突検出方法 | |
JP2004364396A (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 | ||
CP01 | Change in the name or title of a patent holder |
Address after: 510070 15 building, 100 martyrs Road, Yuexiu District, Guangzhou, Guangdong. Patentee after: Institute of intelligent manufacturing, Guangdong Academy of Sciences Address before: 510070 15 building, 100 martyrs Road, Yuexiu District, Guangzhou, Guangdong. Patentee before: GUANGDONG INSTITUTE OF INTELLIGENT MANUFACTURING |
|
CP01 | Change in the name or title of a patent holder |