CN108247654A - 一种机器人的控制方法、装置和*** - Google Patents

一种机器人的控制方法、装置和*** Download PDF

Info

Publication number
CN108247654A
CN108247654A CN201810111000.7A CN201810111000A CN108247654A CN 108247654 A CN108247654 A CN 108247654A CN 201810111000 A CN201810111000 A CN 201810111000A CN 108247654 A CN108247654 A CN 108247654A
Authority
CN
China
Prior art keywords
target
joint
robot
torque
output torque
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.)
Pending
Application number
CN201810111000.7A
Other languages
English (en)
Inventor
李煜
王钰
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Ao Bo (beijing) Technology Co Ltd
Original Assignee
Ao Bo (beijing) Technology Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Ao Bo (beijing) Technology Co Ltd filed Critical Ao Bo (beijing) Technology Co Ltd
Priority to CN201810111000.7A priority Critical patent/CN108247654A/zh
Publication of CN108247654A publication Critical patent/CN108247654A/zh
Pending legal-status Critical Current

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00Controls for manipulators
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/0075Means for protecting the manipulator from its environment or vice versa

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)

Abstract

本发明公开了一种机器人的控制方法、装置和***,该方法包括:获取电流传感器对目标电机检测到的实际电流值,并根据所述实际电流值计算所述目标电机的实际输出力矩;获取目标关节的位置、角速度和角加速度,并根据所述目标关节的位置、角速度和角加速度计算所述目标电机的理论输出力矩;其中,所述目标关节是所述机器人上被所述目标电机控制的机械臂关节;计算所述实际输出力矩和所述理论输出力矩之间的差值;若所述差值大于力矩差阈值,则控制机器人执行安全防护的动作。本申请实施例在确定机器人发生碰撞的情况下就可以使机器人主动触发安全防护的动作,从而避免碰撞对操作人员的伤害,同时也避免碰撞损坏机器人本身。

Description

一种机器人的控制方法、装置和***
技术领域
本发明涉及机器人技术领域,特别是涉及一种机器人的控制方法、装置和***。
背景技术
随着机器人技术的发展,目前机器人已经能够应用到许多不同的领域。在许多具有高灵活度、高柔性等操作要求的领域中,由于机器人目前还难以满足这样的操作要求,因此,机器人通常需要与操作人员在同一空间内共同协作。例如,在医药、视频、物流等行业中,通常工业机器人与操作人员会在一起协作完成工作。在机器人与操作人员共同协作的过程中,由于两者处于同一空间,机器人很可能会碰撞到操作人员。这种碰撞很可能会伤害到操作人员,同时也很可能会损坏机器人本身。
发明内容
本发明所要解决的技术问题是,提供一种机器人的控制方法、装置和***,以使得机器人在发生碰撞的情况下能够被触发安全防护的动作,从而避免碰撞对操作人员的伤害,同时也避免碰撞损坏机器人本身。
第一方面,为解决上述技术问题,本发明提供了一种机器人的控制方法,该方法包括:
获取电流传感器对目标电机检测到的实际电流值,并根据所述实际电流值计算所述目标电机的实际输出力矩;
获取目标关节的位置、角速度和角加速度,并根据所述目标关节的位置、角速度和角加速度计算所述目标电机的理论输出力矩;其中,所述目标关节是所述机器人上被所述目标电机控制的机械臂关节;
计算所述实际输出力矩和所述理论输出力矩之间的差值;
若所述差值大于力矩差阈值,则控制机器人执行安全防护的动作。
可选的,所述实际输出力矩具体为所述实际电流值与所述目标电机的转矩系数的乘积。
可选的,所述理论输出力矩包括所述目标关节的惯量、科氏力和离心力、库伦摩擦力、粘性摩擦力和重力所产生的力矩;
所述目标关节的惯量所产生的力矩由所述目标关节的位置和角加速度确定;
所述目标关节的科氏力和离心力所产生的力矩由所述目标关节的位置和角速度确定;
所述目标关节的库伦摩擦力所产生的力矩由所述目标关节的角速度确定;
所述目标关节的粘性摩擦力所产生的力矩由所述目标关节的角速度确定;
所述目标关节的重力所产生的力矩由所述目标关节的位置确定。
可选的,所述目标关节的角速度和角加速度是通过对所述目标关节的位置进行差分和滤波得到的。
可选的,所述机器人的控制方法还包括:
预先响应于设置阈值的用户操作,将所述用户操作所指示的数值作为所述力矩差阈值。
可选的,所述用户操作具体为在预设的多个可选数值中选取出一个数值的操作,所述用户操作用于指示将选取出的数值作为所述力矩差阈值。
可选的,所述安全防护的动作为进入停止运动的状态。
可选的,所述安全防护的动作具体为所述机器人上所有的机械臂关节均进入停止运动的状态;
其中,所述目标关节为所述机器人上任意一个机械臂关节。
第二方面,为解决上述技术问题,本发明提供了一种机器人的控制装置,该装置包括:
第一获取单元,用于获取电流传感器对目标电机检测到的实际电流值;
第一计算单元,用于根据所述实际电流值计算所述目标电机的实际输出力矩;
第二获取单元,用于获取目标关节的位置、角速度和角加速度;其中,所述目标关节是所述机器人上被所述目标电机控制的机械臂关节;
第二计算单元,用于根据所述目标关节的位置、角速度和角加速度计算所述目标电机的理论输出力矩;
第三计算单元,用于计算所述实际输出力矩和所述理论输出力矩之间的差值;
控制单元,用于若所述差值大于力矩差阈值,则控制机器人执行安全防护的动作。
第三方面,为解决上述技术问题,本发明提供了一种机器人的控制***,该***包括:
控制器、电流传感器、编码器、驱动器和刹车驱动器;
所述控制器,用于获取电流传感器对目标电机检测到的实际电流值并根据所述实际电流值计算所述目标电机的实际输出力矩,获取目标关节的位置、角速度和角加速度并根据所述目标关节的位置、角速度和角加速度计算所述目标电机的理论输出力矩,计算所述实际输出力矩和所述理论输出力矩之间的差值,若所述差值大于力矩差阈值则向所述驱动器发送第一控制指令和/或向所述刹车驱动器发送第二控制指令;
所述电流传感器,用于对所述机器人的目标电机进行电流检测,以获得实际电流值并传送给所述控制器;
所述编码器,用于对目标关节的位置信息进行检测,以获得所述目标电机的位置、角速度和角加速度并传送给所述控制器;其中,所述目标关节是所述机器人上被所述目标电机控制的机械臂关节;
所述驱动器,用于按照所述第一控制指令,控制机器人执行安全防护的动作;
所述刹车驱动器,用于按照所述第二控制指令,控制机器人执行安全防护的动作。
与现有技术相比,本发明具有以下优点:
在本发明实施例中,对于机器人上的机械臂关节及其电机,通过比较由该电机的实际电流值计算出的实际输出力矩与由该关节的位置信息计算出的理论输出力矩,可以确定机器人是否发生了碰撞,这样,在确定机器人发生碰撞的情况下就可以使机器人主动触发安全防护的动作,从而避免碰撞对操作人员的伤害,同时也避免碰撞损坏机器人本身。
附图说明
为了更清楚地说明本申请实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本申请中记载的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本申请实施例提供的机器人产品示意图;
图2本申请实施例提供的机械臂本体的示意图;
图3为本申请实施例提供的机器人的控制方法的流程图;
图4为本申请实施例提供的机器人的控制方法的原理图;
图5为本申请实施例提供的控制机器人某一机械臂关节的流程图;
图6为本申请实施例提供的机器人的控制装置的示意图;
图7为本申请实施例提供的机器人的控制***的示意图。
具体实施方式
为了使本技术领域的人员更好地理解本申请方案,下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。
发明人经过研究发现,通常工业机器人与操作人员会在一起协作完成工作,例如,在医药、物流等行业。在机器人与操作人员共同协作的过程中,由于两者处于同一空间,机器人很可能会碰撞到操作人员。这种碰撞很可能会伤害到操作人员,同时也很可能会损坏机器人本身。
基于此,在本发明实施例中,提供了一种机器人的控制方法和装置,通过计算目标电机控制的机械臂关节的实际输出力矩和理论输出力矩的差值,当所述差值大于力矩差阈值时,认为机器人发生了碰撞,当机器人发生碰撞时控制机器人执行安全防护的动作,从而避免机器人伤害到操作人员,也避免机器人自身损伤。
如图1所示,该图为本申请实施例提供的机器人产品示意图,本发明实施例涉及的产品包括:一个机械臂本体,一个控制柜和一个示教器。
如图2所示,该图为本发明实施例提供的机械臂本体的示意图。机器人本体模仿人的手臂,共有6个旋转关节,每个关节表示一个自由度。机器人关节包括基座(关节1)、肩部(关节2)、肘部(关节3)、腕部1(关节4)、腕部2(关节5)、腕部3(关节6)。基座用于机器人本体和底座连接,工具端用于机器人与工具连接。肩部和肘部之间以及肘部和腕部之间采用臂管连接。通过示教器操作界面或拖动示教,用户可以控制各个关节转动,使机器人工具移动到不同的位姿。
下面结合附图,通过实施例来详细说明本发明实施例中机器人的控制方法的具体实现方式。
示例性方法
参见图3,该图为本实施例提供的机器人的控制方法的流程图。本实施例提供的机器人的控制方法,包括如下步骤:
S301:获取电流传感器对目标电机检测到的实际电流值,并根据所述实际电流值计算所述目标电机的实际输出力矩。
可以理解的是,当机械臂运动时,各个关节运动需要的驱动力矩由相应的电机提供,为各关节运动提供驱动力矩的电机通常为直流力矩电机。而直流力矩电机的实际输出力矩与电流成正比关系,具体地,所述实际输出力矩为所述实际电流值和所述目标电机的转矩系数的乘积,即τreal=Ki,其中,τreal表示所述实际输出力矩,K表示所述目标电机的转矩系数,i表示所述实际电流值。
需要说明的是,所述目标电机有与之对应的电流传感器和控制器,可以通过电流传感器获得所述目标电机的实际电流值,电流传感器将所述目标电机的实际电流值发送给控制器,控制器通过计算获得所述目标电机的实际输出力矩。
S302:获取目标关节的位置、角速度和角加速度,并根据所述目标关节的位置、角速度和角加速度计算所述目标电机的理论输出力矩;其中,所述目标关节是所述机器人上被所述目标电机控制的机械臂关节。
需要说明的是,机械臂在运动时,目标电机控制的目标关节可能会有一定的角速度和角加速度,例如腕部3(关节6)发生旋转时具有一定的角速度和角加速度。目标关节的角速度和角加速度是所述目标电机的理论输出力矩的影响因素。除此之外,所述目标关节的位置也是所述目标电机的理论输出力矩的一个影响因素。
需要说明的是,根据所述目标关节的位置、角速度和角加速度计算所述目标电机的理论输出力矩,所述理论输出力矩包括所述目标关节的惯量、科氏力和离心力、库伦摩擦力、粘性摩擦力和重力所产生的力矩。具体地:
以下对式(1)进行说明,假设机器人的关节数为N,式(1)中:
τ表示所述理论输出力矩。
q表示各关节位置向量,为N×1的向量。
为各关节加速度向量,为N×1的向量。
为各关节角加速度向量,,为N×1的向量。
为所述目标关节的惯量产生的力矩,所述目标关节的惯量产生的力矩由所述目标关节的位置和角加速度确定。
为所述目标关节的科氏力和离心力所产生的力矩,所述目标关节的科氏力和离心力所产生的力矩由所述目标关节的位置和角速度确定。其中,为N×N的科氏力和离心力矩阵。
为所述目标关节的库伦摩擦力所产生的力矩,所述库伦摩擦力所产生的力矩由所述目标关节的角速度确定。其中,FS为N×N的库仑摩擦力矩阵,为以为自变量的符号函数。
FV为所述目标关节的粘性摩擦力所产生的力矩,所述目标关节所产生的力矩由所述目标关节的角速度确认。其中,FV为N×N的粘性摩擦力矩阵。
G(q)为所述目标关节的重力所产生的力矩,所述目标关节的重力所产生的力矩由所述目标关节的角速度确定。其中,G(q)为N×1的重力向量。
需要说明的是,所述目标电机有与之对应的编码器,可以根据编码器获得所述目标电机控制的目标关节的位置,对所述目标关节的位置进行差分、滤波之后可得到所述目标关节的角速度和角加速度。编码器获得所述目标电机的位置、角速度和角加速度之后可以将所述目标电机的位置、角速度和角加速度发送给控制器,由控制器计算所述目标电机的理论输出力矩。
需要说明的是,本实施例中不限定S301和S302的执行顺序,S301可以在S302之后执行,S301也可以与S302同时执行。
S303:计算所述实际输出力矩和理论输出力矩之间的差值。
可以理解的是,控制器获得所述实际输出力矩和所述理论输出力矩之后可以通过计算获得所述实际输出力矩和理论输出力矩之间的差值。
S304:若所述差值大于力矩差阈值,则控制机器人执行安全防护的动作。
可以理解的是,所述力矩差阈值可以是所述机器人安全工作范围内实际输出力矩和理论输出力矩的偏差的最大值。
需要说明的是,所述力矩差阈值可以是用户预先设置的。具体实现时,预先响应于设置阈值的用户操作,将所述用户操作所指示的数值作为所述力矩差阈值。
在一种可能的实施方式中,所述用户操作可以具体为在预设的多个可选数值中选取出一个数值的操作,所述用户操作用户指示将选取出的数值作为所述力矩差阈值。
可以理解的是,机器人的应用场景不同,对安全性的要求也不同,故而可以为机器人设置安全等级,每个等级设置有对应的力矩差阈值。用户可以根据机器人的实际应用场景对安全性的要求选择对应的力矩差阈值。
需要说明的是,本实施例中提及的安全防护动作为进入停止运动的状态。
可以理解的是,机械臂本体上有多个关节,各个关节都有可能发生碰撞,导致所述关节对应的电机的实际输出力矩与理论输出力矩的差值大于所述力矩差阈值,在本实施例中,机械臂本体上任意一个机械臂关节发生碰撞时,所述安全防护的动作具体为所述机器人上所有的机械臂关节均进入停止运动的状态。从而有效的避免碰撞对操作人员的伤害,同时也有效避免碰撞损坏机器人本身。
需要说明的是,本实施例中各个目标关节对应的目标电机有对应的驱动器和刹车驱动器。其中,驱动器为所述目标电机的驱动电路部分,驱动器可以驱动所述电机工作,也可以控制所述电机停止工作。刹车驱动器是机械臂关节的刹车,分为抱死和松开两个状态,刹车抱死时所述机械臂关节可以在短时间内进入停止工作状态。
本实施例中提及的安全防护的动作的执行可以由驱动器和/或刹车驱动器来完成。当控制器判断所述差值大于力矩差阈值时,可以向所述驱动器发送第一控制指令和/或刹车驱动器发送第二控制指令。驱动器接收到所述第一控制指令后控制所述目标电机停止工作,从而控制机械臂关节进入停止运动的状态。刹车驱动器接收到所述第二控制指令之后,刹车进入抱死状态,从而控制机械臂关节进入停止运动的状态。
以下结合具体场景介绍本申请提供的机器人的控制方法。
参见图4,该图为本申请实施例提供的机器人的控制方法的原理图。
参见图5,该图为本申请实施例提供的控制机器人某一机械臂关节的流程图。
S501:微控制单元(Microcontroller Unit,MCU)通过驱动器驱动电机工作,机械臂关节进入工作状态。
其中,驱动器为电机的驱动电路部分,由MOS管及MOS管驱动组成,驱动器可以驱动所述电机工作,也可以控制所述电机停止工作。
其中,MCU主要负责电机的驱动并与控制器通过电流分析板进行通信,将电机的状态信息上传给控制器。
其中,电流分析板主要负责MCU与控制板之间的通信。
S502:编码器A和编码器B获得机械臂关节的位置、角速度和角加速度,并通过MCU和电流分析板将所述机械臂关节的位置、角速度和角加速度发送给控制器。
需要说明的是,编码器A为绝对编码器,可以获得机械臂关节的绝对位置信息。编码器B为增量式编码器,可以获得电机的相对位置信息及速度、加速度等信息。结合编码器A和编码器B可以获得所述机械臂关节的位置、角速度进而角加速度信息。
可以理解的是,编码器A和编码器B也可以集成为一个编码器。
编码器A和编码器B可以为一个编码器,也可以为多个编码器。功能如上。
S503:电流传感器检测电机的实际电流值,并将所述实际电流值通过MCU和电流分析板发送给控制器。
S504:控制器计算电机的实际输出力矩和理论输出力矩,并计算所述实际输出力矩和所述理论输出力矩的差值。
S505:判断所述差值大于所述力矩差阈值,通过MCU控制刹车驱动器进入抱死状态,从而控制机械臂关节停止运动。
需要说明的是,图4中所示的编码器A、编码器B、驱动器、刹车驱动器、电流传感器可以集成为一个电机驱动板。
本实施例提供的机器人的控制方法,对于机器人上的机械臂关节及其电机,通过比较由该电机的实际电流值计算出的实际输出力矩与由该关节的位置信息计算出的理论输出力矩,可以确定机器人是否发生了碰撞,这样,在确定机器人发生碰撞的情况下就可以使机器人主动触发安全防护的动作,从而避免碰撞对操作人员的伤害,同时也避免碰撞损坏机器人本身。
示例性装置
基于本申请实施例提供的机器人的控制方法,本申请还提供一种机器人的控制装置,参见图6,该图为本申请实施例提供的机器人的控制装置的示意图,本实施例提供的机器人的控制装置,包括:
第一获取单元610、第一计算单元620、第二获取单元630、第二计算单元640、第三计算单元650和控制单元660。
所述第一获取单元610,用于获取电流传感器对目标电机检测到的实际电流值。
所述第一计算单元620,用于根据所述实际电流值计算所述目标电机的实际输出力矩。
可选的,所述实际输出力矩具体为所述实际电流值与所述目标电机的转矩系数的乘积。
所述第二获取单元630,用于获取目标关节的位置、角速度和角加速度;其中,所述目标关节是所述机器人上被所述目标电机控制的机械臂关节。
可选的,所述目标关节的角速度和角加速度是通过对所述目标关节的位置进行差分和滤波得到的。
所述第二计算单元640,用于根据所述目标关节的位置、角速度和角加速度计算所述目标电机的理论输出力矩。
可选的,所述理论输出力矩包括所述目标关节的惯量、科氏力和离心力、库伦摩擦力、粘性摩擦力和重力所产生的力矩;
所述目标关节的惯量所产生的力矩由所述目标关节的位置和角加速度确定;
所述目标关节的科氏力和离心力所产生的力矩由所述目标关节的位置和角速度确定;
所述目标关节的库伦摩擦力所产生的力矩由所述目标关节的角速度确定;
所述目标关节的粘性摩擦力所产生的力矩由所述目标关节的角速度确定;
所述目标关节的重力所产生的力矩由所述目标关节的位置确定。
所述第三计算单元650,用于计算所述实际输出力矩和所述理论输出力矩之间的差值。
所述控制单元660,用于若所述差值大于力矩差阈值,则控制机器人执行安全防护的动作。
可选的,所述安全防护的动作为进入停止运动的状态。
可选的,所述安全防护的动作具体为所述机器人上所有的机械臂关节均进入停止运动的状态;其中,所述目标关节为所述机器人上任意一个机械臂关节。
可选的,所述装置还包括阈值设置单元。
所述阈值设置单元用于:预先响应于设置阈值的用户操作,将所述用户操作所指示的数值作为所述力矩差阈值。
可选的,所述用户操作具体为在预设的多个可选数值中选取出一个数值的操作,所述用户操作用于指示将选取出的数值作为所述力矩差阈值。
本实施例提供的机器人的控制装置,对于机器人上的机械臂关节及其电机,通过比较由该电机的实际电流值计算出的实际输出力矩与由该关节的位置信息计算出的理论输出力矩,可以确定机器人是否发生了碰撞,这样,在确定机器人发生碰撞的情况下就可以使机器人主动触发安全防护的动作,从而避免碰撞对操作人员的伤害,同时也避免碰撞损坏机器人本身。
示例性***
基于本申请实施例提供的机器人的控制方法和装置,本申请还提供一种机器人的控制***,参见图7,该图为本申请实施例提供的机器人的控制***的示意图,本实施例提供的机器人的控制***,包括:
控制器710、电流传感器720、编码器730、驱动器740和刹车驱动器750。
所述控制器710,用于获取电流传感器对目标电机检测到的实际电流值并根据所述实际电流值计算所述目标电机的实际输出力矩,获取目标关节的位置、角速度和角加速度并根据所述目标关节的位置、角速度和角加速度计算所述目标电机的理论输出力矩,计算所述实际输出力矩和所述理论输出力矩之间的差值,若所述差值大于力矩差阈值则向所述驱动器发送第一控制指令和/或向所述刹车驱动器发送第二控制指令。
所述电流传感器720,用于对所述机器人的目标电机进行电流检测,以获得实际电流值并传送给所述控制器。
所述编码器730,用于对目标关节的位置信息进行检测,以获得所述目标电机的位置、角速度和角加速度并传送给所述控制器;其中,所述目标关节是所述机器人上被所述目标电机控制的机械臂关节。
所述驱动器740,用于按照所述第一控制指令,控制机器人执行安全防护的动作。
所述刹车驱动器750,用于按照。所述第二控制指令,控制机器人执行安全防护的动作。
本实施例提供的机器人的控制***,对于机器人上的机械臂关节及其电机,通过比较由该电机的实际电流值计算出的实际输出力矩与由该关节的位置信息计算出的理论输出力矩,可以确定机器人是否发生了碰撞,这样,在确定机器人发生碰撞的情况下就可以使机器人主动触发安全防护的动作,从而避免碰撞对操作人员的伤害,同时也避免碰撞损坏机器人本身。
需要说明的是,在本文中,诸如“第一获取单元”和“第二获取单元”等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。
对于装置实施例而言,由于其基本对应于方法实施例,所以相关之处参见方法实施例的部分说明即可。以上所描述的***实施例仅仅是示意性的,其中所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部模块来实现本实施例方案的目的。本领域普通技术人员在不付出创造性劳动的情况下,即可以理解并实施。
以上所述仅是本申请的具体实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本申请原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本申请的保护范围。

Claims (10)

1.一种机器人的控制方法,其特征在于,包括:
获取电流传感器对目标电机检测到的实际电流值,并根据所述实际电流值计算所述目标电机的实际输出力矩;
获取目标关节的位置、角速度和角加速度,并根据所述目标关节的位置、角速度和角加速度计算所述目标电机的理论输出力矩;其中,所述目标关节是所述机器人上被所述目标电机控制的机械臂关节;
计算所述实际输出力矩和所述理论输出力矩之间的差值;
若所述差值大于力矩差阈值,则控制机器人执行安全防护的动作。
2.根据权利要求1所述的方法,其特征在于,所述实际输出力矩具体为所述实际电流值与所述目标电机的转矩系数通过非线性相乘而得到的。
3.根据权利要求1所述的方法,其特征在于,所述理论输出力矩包括所述目标关节的惯量、科氏力和离心力、库伦摩擦力、粘性摩擦力和重力所产生的力矩;
所述目标关节的惯量所产生的力矩由所述目标关节角加速度确定;
所述目标关节的科氏力和离心力所产生的力矩由所述目标关节的位置和角速度确定;
所述目标关节的库伦摩擦力所产生的力矩由所述目标关节的角速度确定;
所述目标关节的粘性摩擦力所产生的力矩由所述目标关节的角速度确定;
所述目标关节的重力所产生的力矩由所述目标关节的位置确定。
4.根据权利要求1所述的方法,其特征在于,所述目标关节的角速度是通过对所述目标关节的位置进行差分和滤波得到的,所述目标关节的角加速度对所述目标关节的角速度进行差分和滤波得到的。
5.根据权利要求1所述的方法,其特征在于,还包括:
预先响应于设置阈值的用户操作,将所述用户操作所指示的数值作为所述力矩差阈值。
6.根据权利要求5所述的方法,其特征在于,所述用户操作具体为在预设的多个可选数值中选取出一个数值的操作,所述用户操作用于指示将选取出的数值作为所述力矩差阈值。
7.根据权利要求1所述的方法,其特征在于,所述安全防护的动作为进入停止运动的状态。
8.根据权利要求7所述的方法,其特征在于,所述安全防护的动作具体为所述机器人上所有的机械臂关节均进入停止运动的状态;
其中,所述目标关节为所述机器人上任意一个机械臂关节。
9.一种机器人的控制装置,其特征在于,包括:
第一获取单元,用于获取电流传感器对目标电机检测到的实际电流值;
第一计算单元,用于根据所述实际电流值计算所述目标电机的实际输出力矩;
第二获取单元,用于获取目标关节的位置、角速度和角加速度;其中,所述目标关节是所述机器人上被所述目标电机控制的机械臂关节;
第二计算单元,用于根据所述目标关节的位置、角速度和角加速度计算所述目标电机的理论输出力矩;
第三计算单元,用于计算所述实际输出力矩和所述理论输出力矩之间的差值;
控制单元,用于若所述差值大于力矩差阈值,则控制机器人执行安全防护的动作。
10.一种机器人的控制***,其特征在于,包括控制器、电流传感器、编码器、驱动器和刹车驱动器;
所述电流传感器,用于对所述机器人的目标电机进行电流检测,以获得实际电流值并传送给所述控制器;
所述编码器,用于对目标关节的位置信息进行检测,以获得所述目标电机的位置、角速度和角加速度并传送给所述控制器;其中,所述目标关节是所述机器人上被所述目标电机控制的机械臂关节;
所述控制器,用于获取电流传感器对目标电机检测到的实际电流值并根据所述实际电流值计算所述目标电机的实际输出力矩,获取目标关节的位置、角速度和角加速度并根据所述目标关节的位置、角速度和角加速度计算所述目标电机的理论输出力矩,计算所述实际输出力矩和所述理论输出力矩之间的差值,若所述差值大于力矩差阈值则向所述驱动器发送第一控制指令和/或向所述刹车驱动器发送第二控制指令;
所述驱动器,用于按照所述第一控制指令,控制机器人执行安全防护的动作;
所述刹车驱动器,用于按照所述第二控制指令,控制机器人执行安全防护的动作。
CN201810111000.7A 2018-02-05 2018-02-05 一种机器人的控制方法、装置和*** Pending CN108247654A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810111000.7A CN108247654A (zh) 2018-02-05 2018-02-05 一种机器人的控制方法、装置和***

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810111000.7A CN108247654A (zh) 2018-02-05 2018-02-05 一种机器人的控制方法、装置和***

Publications (1)

Publication Number Publication Date
CN108247654A true CN108247654A (zh) 2018-07-06

Family

ID=62743861

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810111000.7A Pending CN108247654A (zh) 2018-02-05 2018-02-05 一种机器人的控制方法、装置和***

Country Status (1)

Country Link
CN (1) CN108247654A (zh)

Cited By (26)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109079800A (zh) * 2018-10-29 2018-12-25 珠海格力智能装备有限公司 机器人碰撞检测方法、装置、存储介质、处理器及机器人
CN109079856A (zh) * 2018-10-30 2018-12-25 珠海格力智能装备有限公司 机器人的碰撞检测方法和装置
CN109093623A (zh) * 2018-08-24 2018-12-28 北京秘塔网络科技有限公司 一种基于闭环结构的扭矩计算、碰撞检测与拖动示教方法
CN109202873A (zh) * 2018-11-22 2019-01-15 北京秘塔网络科技有限公司 一种柔性协作机械臂及其控制方法
CN109318232A (zh) * 2018-10-22 2019-02-12 佛山智能装备技术研究院 一种工业机器人的多元感知***
CN109500820A (zh) * 2018-12-25 2019-03-22 合肥欣奕华智能机器有限公司 一种机器人控制***、机器人运动状态监控方法及机器人
CN109746913A (zh) * 2018-12-29 2019-05-14 深圳市大象机器人科技有限公司 一种机器人姿势保持拖动示教的方法及***
CN110053043A (zh) * 2019-03-05 2019-07-26 华南理工大学 一种工业机器人碰撞检测方法、装置、电子设备及介质
CN110978064A (zh) * 2019-12-11 2020-04-10 山东大学 人机协作中人体安全评估方法及***
CN111290266A (zh) * 2018-12-10 2020-06-16 北京京东尚科信息技术有限公司 用于发送信息的方法和装置
CN111388093A (zh) * 2020-02-19 2020-07-10 哈尔滨工业大学 一种基于协作关节电机的机器人及其控制方法
CN111993463A (zh) * 2020-07-10 2020-11-27 武汉海默机器人有限公司 一种机器人插针式刹车及其控制方法
CN112238437A (zh) * 2020-09-01 2021-01-19 深圳拓邦股份有限公司 一种充电对接的控制方法以及装置
CN112405554A (zh) * 2020-11-06 2021-02-26 上海傅利叶智能科技有限公司 用于机器人低刚度运动控制的方法、装置和康复机器人
CN112405524A (zh) * 2020-10-20 2021-02-26 深圳拓邦股份有限公司 机器人碰撞检测方法、装置及机器人
CN112678260A (zh) * 2021-01-07 2021-04-20 弗兰卡餐饮设备安装技术服务(中国)有限公司 称重分配装置、称重分配方法及计算机可读存储介质
CN112923968A (zh) * 2019-12-06 2021-06-08 纳恩博(北京)科技有限公司 碰撞检测方法、装置、存储介质及电子装置
CN113285653A (zh) * 2021-05-26 2021-08-20 三菱电机自动化(中国)有限公司 伺服控制装置碰撞防护***、方法及计算机可读取介质
CN113673153A (zh) * 2021-08-11 2021-11-19 追觅创新科技(苏州)有限公司 机器人电磁转矩的确定方法和装置、存储介质、电子装置
CN114074325A (zh) * 2020-08-14 2022-02-22 苏州艾利特机器人有限公司 一种确保机器人力边界限制的安全***
CN114102587A (zh) * 2021-11-17 2022-03-01 达闼机器人有限公司 机器人控制方法、***、电子设备和存储介质
CN114516052A (zh) * 2022-03-23 2022-05-20 杭州湖西云百生科技有限公司 并行实时高性能多轴机械臂的动力学控制方法及***
CN114964593A (zh) * 2022-06-21 2022-08-30 郑州安杰莱智能科技有限公司 电流力矩的转换方法、装置及康复机器人
CN115674190A (zh) * 2022-09-30 2023-02-03 深圳市越疆科技有限公司 协作机械臂及其运动控制方法、碰撞检测方法、控制***
WO2023060423A1 (en) * 2021-10-12 2023-04-20 Shanghai Flexiv Robotics Technology Co., Ltd. Safety system, joint assembly with safety system, and robot having joint assembly
CN117415856A (zh) * 2023-10-11 2024-01-19 北京理工大学 一种机器人关节直线液压驱动机构输出力高精度检测方法

Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH1110580A (ja) * 1997-06-26 1999-01-19 Nachi Fujikoshi Corp 産業用ロボットの駆動軸制御方法及びその装置
JP2002283276A (ja) * 2001-03-21 2002-10-03 Daihen Corp 多関節ロボットにおける衝突検出・停止制御法
JP2004017248A (ja) * 2002-06-19 2004-01-22 Osaka Industrial Promotion Organization ロボット及びロボット操作システム
CN102426391A (zh) * 2011-09-05 2012-04-25 华南理工大学 一种判断机器人运行是否发生碰撞的方法
CN104985598A (zh) * 2015-06-24 2015-10-21 南京埃斯顿机器人工程有限公司 一种工业机器人碰撞检测方法
CN204807301U (zh) * 2015-04-20 2015-11-25 重庆有法数控设备有限责任公司 一种伺服驱动器的实时在线测试***
CN105313142A (zh) * 2014-07-31 2016-02-10 发那科株式会社 移动式人机协调型机器人
CN106313053A (zh) * 2016-10-21 2017-01-11 北京七星华创电子股份有限公司 一种具有防撞功能的传片机械手及其防撞方法
CN106625609A (zh) * 2017-02-14 2017-05-10 上海木爷机器人技术有限公司 一种防碰撞结构及机器人
CN106994686A (zh) * 2016-12-01 2017-08-01 遨博(北京)智能科技有限公司 关节外力力矩的计算方法及装置、机器人
CN107253196A (zh) * 2017-08-01 2017-10-17 中科新松有限公司 一种机械臂碰撞检测方法、装置、设备及存储介质
CN208614800U (zh) * 2018-02-05 2019-03-19 遨博(北京)智能科技有限公司 一种机器人的控制***

Patent Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH1110580A (ja) * 1997-06-26 1999-01-19 Nachi Fujikoshi Corp 産業用ロボットの駆動軸制御方法及びその装置
JP2002283276A (ja) * 2001-03-21 2002-10-03 Daihen Corp 多関節ロボットにおける衝突検出・停止制御法
JP2004017248A (ja) * 2002-06-19 2004-01-22 Osaka Industrial Promotion Organization ロボット及びロボット操作システム
CN102426391A (zh) * 2011-09-05 2012-04-25 华南理工大学 一种判断机器人运行是否发生碰撞的方法
CN105313142A (zh) * 2014-07-31 2016-02-10 发那科株式会社 移动式人机协调型机器人
CN204807301U (zh) * 2015-04-20 2015-11-25 重庆有法数控设备有限责任公司 一种伺服驱动器的实时在线测试***
CN104985598A (zh) * 2015-06-24 2015-10-21 南京埃斯顿机器人工程有限公司 一种工业机器人碰撞检测方法
CN106313053A (zh) * 2016-10-21 2017-01-11 北京七星华创电子股份有限公司 一种具有防撞功能的传片机械手及其防撞方法
CN106994686A (zh) * 2016-12-01 2017-08-01 遨博(北京)智能科技有限公司 关节外力力矩的计算方法及装置、机器人
CN106625609A (zh) * 2017-02-14 2017-05-10 上海木爷机器人技术有限公司 一种防碰撞结构及机器人
CN107253196A (zh) * 2017-08-01 2017-10-17 中科新松有限公司 一种机械臂碰撞检测方法、装置、设备及存储介质
CN208614800U (zh) * 2018-02-05 2019-03-19 遨博(北京)智能科技有限公司 一种机器人的控制***

Cited By (38)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109093623A (zh) * 2018-08-24 2018-12-28 北京秘塔网络科技有限公司 一种基于闭环结构的扭矩计算、碰撞检测与拖动示教方法
CN109318232A (zh) * 2018-10-22 2019-02-12 佛山智能装备技术研究院 一种工业机器人的多元感知***
CN109079800A (zh) * 2018-10-29 2018-12-25 珠海格力智能装备有限公司 机器人碰撞检测方法、装置、存储介质、处理器及机器人
CN109079856A (zh) * 2018-10-30 2018-12-25 珠海格力智能装备有限公司 机器人的碰撞检测方法和装置
CN109202873A (zh) * 2018-11-22 2019-01-15 北京秘塔网络科技有限公司 一种柔性协作机械臂及其控制方法
CN111290266A (zh) * 2018-12-10 2020-06-16 北京京东尚科信息技术有限公司 用于发送信息的方法和装置
CN109500820A (zh) * 2018-12-25 2019-03-22 合肥欣奕华智能机器有限公司 一种机器人控制***、机器人运动状态监控方法及机器人
CN109746913B (zh) * 2018-12-29 2022-03-15 深圳市大象机器人科技有限公司 一种机器人姿势保持拖动示教的方法及***
CN109746913A (zh) * 2018-12-29 2019-05-14 深圳市大象机器人科技有限公司 一种机器人姿势保持拖动示教的方法及***
CN110053043A (zh) * 2019-03-05 2019-07-26 华南理工大学 一种工业机器人碰撞检测方法、装置、电子设备及介质
CN112923968A (zh) * 2019-12-06 2021-06-08 纳恩博(北京)科技有限公司 碰撞检测方法、装置、存储介质及电子装置
CN110978064A (zh) * 2019-12-11 2020-04-10 山东大学 人机协作中人体安全评估方法及***
CN110978064B (zh) * 2019-12-11 2022-06-24 山东大学 人机协作中人体安全评估方法及***
CN111388093A (zh) * 2020-02-19 2020-07-10 哈尔滨工业大学 一种基于协作关节电机的机器人及其控制方法
CN111993463B (zh) * 2020-07-10 2023-10-13 武汉海默机器人有限公司 一种机器人插针式刹车及其控制方法
CN111993463A (zh) * 2020-07-10 2020-11-27 武汉海默机器人有限公司 一种机器人插针式刹车及其控制方法
CN114074325B (zh) * 2020-08-14 2024-05-24 苏州艾利特机器人有限公司 一种确保机器人力边界限制的安全***
CN114074325A (zh) * 2020-08-14 2022-02-22 苏州艾利特机器人有限公司 一种确保机器人力边界限制的安全***
CN112238437A (zh) * 2020-09-01 2021-01-19 深圳拓邦股份有限公司 一种充电对接的控制方法以及装置
CN112238437B (zh) * 2020-09-01 2022-06-17 深圳拓邦股份有限公司 一种充电对接的控制方法以及装置
CN112405524B (zh) * 2020-10-20 2022-11-11 深圳拓邦股份有限公司 机器人碰撞检测方法、装置及机器人
CN112405524A (zh) * 2020-10-20 2021-02-26 深圳拓邦股份有限公司 机器人碰撞检测方法、装置及机器人
CN112405554A (zh) * 2020-11-06 2021-02-26 上海傅利叶智能科技有限公司 用于机器人低刚度运动控制的方法、装置和康复机器人
CN112405554B (zh) * 2020-11-06 2022-07-01 上海傅利叶智能科技有限公司 用于机器人低刚度运动控制的方法、装置和康复机器人
CN112678260A (zh) * 2021-01-07 2021-04-20 弗兰卡餐饮设备安装技术服务(中国)有限公司 称重分配装置、称重分配方法及计算机可读存储介质
CN113285653A (zh) * 2021-05-26 2021-08-20 三菱电机自动化(中国)有限公司 伺服控制装置碰撞防护***、方法及计算机可读取介质
CN113673153A (zh) * 2021-08-11 2021-11-19 追觅创新科技(苏州)有限公司 机器人电磁转矩的确定方法和装置、存储介质、电子装置
WO2023060423A1 (en) * 2021-10-12 2023-04-20 Shanghai Flexiv Robotics Technology Co., Ltd. Safety system, joint assembly with safety system, and robot having joint assembly
CN114102587A (zh) * 2021-11-17 2022-03-01 达闼机器人有限公司 机器人控制方法、***、电子设备和存储介质
CN114102587B (zh) * 2021-11-17 2023-10-03 达闼机器人股份有限公司 机器人控制方法、***、电子设备和存储介质
CN114516052B (zh) * 2022-03-23 2023-12-22 杭州湖西云百生科技有限公司 并行实时高性能多轴机械臂的动力学控制方法及***
CN114516052A (zh) * 2022-03-23 2022-05-20 杭州湖西云百生科技有限公司 并行实时高性能多轴机械臂的动力学控制方法及***
CN114964593A (zh) * 2022-06-21 2022-08-30 郑州安杰莱智能科技有限公司 电流力矩的转换方法、装置及康复机器人
CN115674190A (zh) * 2022-09-30 2023-02-03 深圳市越疆科技有限公司 协作机械臂及其运动控制方法、碰撞检测方法、控制***
WO2024066063A1 (zh) * 2022-09-30 2024-04-04 深圳市越疆科技有限公司 协作机械臂及其运动控制方法、碰撞检测方法、控制***
CN115674190B (zh) * 2022-09-30 2024-05-07 深圳市越疆科技股份有限公司 协作机械臂及其运动控制方法、碰撞检测方法、控制***
CN117415856A (zh) * 2023-10-11 2024-01-19 北京理工大学 一种机器人关节直线液压驱动机构输出力高精度检测方法
CN117415856B (zh) * 2023-10-11 2024-05-10 北京理工大学 一种机器人关节直线液压驱动机构输出力高精度检测方法

Similar Documents

Publication Publication Date Title
CN108247654A (zh) 一种机器人的控制方法、装置和***
CN208614800U (zh) 一种机器人的控制***
CN110696000B (zh) 一种机械臂试探感知的避障方法
US11197730B2 (en) Manipulator system
KR101982226B1 (ko) 로봇 시스템
Thomas et al. Human‐robot collaboration–new applications in industrial robotics
CN108015774B (zh) 一种无需传感器的机械臂碰撞检测方法
CN110465935B (zh) 用于机器人编程的方法、设备和***
EP3498433A1 (en) Dynamical safety trajectories in a robotic system
JP6659629B2 (ja) 多関節ロボットの制御装置
CN106485746A (zh) 基于图像无标定的视觉伺服机械手及其控制方法
CN107088878B (zh) 计算扫描空间的机器人的模拟装置
CN105382840A (zh) 机器人的控制装置以及控制方法
CN105034010A (zh) 进行机器人的灵活控制的控制装置
JP2016190292A (ja) ロボット制御装置、ロボットシステムおよびロボット制御方法
Kormushev et al. Kinematic-free position control of a 2-dof planar robot arm
JP5471636B2 (ja) ロボットシステム
JP5633623B2 (ja) ロボットシステム
JPH01310889A (ja) 産業用ロボットの制御装置
US9199377B2 (en) Method and system for extracting intended torque for wearable robot
CN111356558A (zh) 用于仿真机器人的制动过程的方法和***
WO2017141579A1 (ja) 判定装置、制御装置、制御システム、判定方法およびプログラム
JP4577607B2 (ja) ロボットの制御装置およびロボットシステム
Motoi et al. Experimental operability evaluation of remote control with force feedback for mobile robot
Kobayashi et al. Human motion caption with vision and inertial sensors for hand/arm robot teleoperation

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
CB02 Change of applicant information

Address after: Room 407, building 5, yard 98, lianshihu West Road, Mentougou District, Beijing 102300

Applicant after: AUBO (Beijing) Intelligent Technology Co.,Ltd.

Address before: 102300 Floor 3, Shilong Sunshine Building, Lianshihu West Road, Mentougou District, Beijing

Applicant before: AUBO (BEIJING) ROBOTICS TECHNOLOGY Co.,Ltd.

CB02 Change of applicant information