CN108608427B - 机器人力控牵引过程中的避奇异方法及装置 - Google Patents
机器人力控牵引过程中的避奇异方法及装置 Download PDFInfo
- Publication number
- CN108608427B CN108608427B CN201810569295.2A CN201810569295A CN108608427B CN 108608427 B CN108608427 B CN 108608427B CN 201810569295 A CN201810569295 A CN 201810569295A CN 108608427 B CN108608427 B CN 108608427B
- Authority
- CN
- China
- Prior art keywords
- operability index
- operability
- robot
- target robot
- force
- 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 121
- 230000008569 process Effects 0.000 title claims abstract description 73
- 230000009471 action Effects 0.000 claims abstract description 12
- 238000004364 calculation method Methods 0.000 claims description 29
- 230000000452 restraining effect Effects 0.000 claims description 11
- 239000011159 matrix material Substances 0.000 claims description 9
- 238000013459 approach Methods 0.000 claims description 4
- 230000006870 function Effects 0.000 description 10
- 238000010586 diagram Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000004590 computer program Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 238000013519 translation Methods 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
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
- B25J9/1666—Avoiding collision or forbidden zones
-
- 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/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/1607—Calculation of inertia, jacobian matrixes and inverses
-
- 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/1628—Programme controls characterised by the control loop
- B25J9/1653—Programme controls characterised by the control loop parameters identification, estimation, stiffness, accuracy, error analysis
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
Abstract
本发明提供了一种机器人力控牵引过程中的避奇异方法及装置,该方法包括:实时计算目标机器人的可操作性指标;根据可操作性指标确定目标机器人是否接近奇异位形;如果确定得到目标机器人接近奇异位形,则基于可操作性指标计算约束力,并通过驱动器向目标机器人额外施加约束力,以使目标机器人在约束力的作用下避开奇异位形继续运动。该方法能够有效避免机器人到达奇异位形,使得力控牵引的过程能够连续不断进行,改善了力控牵引的操作体验,提高了力控牵引的操作效率,缓解了现有的机器人在进行力控牵引的过程中,因操作者将机器人牵引至奇异位形所导致的机器人报警停机,致使力控牵引操作效率低下,操作体验差的技术问题。
Description
技术领域
本发明涉及机器人的技术领域,尤其是涉及一种机器人力控牵引过程中的避奇异方法及装置。
背景技术
目前,机器人的避奇异一般是在位置控制中进行,当机械臂运动至接近奇异位形的时候,机器人会停止动作,并发出报警。或者在进行轨迹规划的时候就考虑到避奇异的问题,使生成的轨迹远离奇异位形。
为了能够实现机器人的位置控制,牵引示教(即力控牵引)是一个必不可少的前提。在协作型机器人的力控牵引过程中:先在机器人的示教器上点击牵引示教按钮,使机器人进入牵引状态;然后操作者抓住机器人的末端,并往任意方向施加一定的力;控制器检测到操作者施加的力信号后,给驱动器发送位置信息,控制机器人往施加力的方向进行运动。
在此过程中,由于机器人是跟随操作者施加的力在运动,因此有可能导致机器人达到奇异位形。现有的技术对这种情况的处理方式是报警并停机,如果重新操作需要先对机器人进行复位,这就影响了力控牵引的操作体验,降低了操作效率。
综上,在现有的机器人力控牵引过程中,操作者常常会将机器人牵引至奇异位形而导致机器人报警停机,影响了力控牵引的操作体验,降低了操作效率。
发明内容
有鉴于此,本发明的目的在于提供一种机器人力控牵引过程中的避奇异方法及装置,以缓解现有的机器人力控牵引过程中,因操作者将机器人牵引至奇异位形所导致的机器人报警停机,致使力控牵引操作效率低下,操作体验差的技术问题。
第一方面,本发明实施例提供了一种机器人力控牵引过程中的避奇异方法,应用于控制器,所述方法包括:
实时计算目标机器人的可操作性指标,其中,所述目标机器人为在笛卡尔空间中,***作者进行力控牵引的机器人;
根据所述可操作性指标确定所述目标机器人是否接近奇异位形;
如果确定得到所述目标机器人接近所述奇异位形,则基于所述可操作性指标计算约束力,并通过驱动器向所述目标机器人额外施加所述约束力,以使所述目标机器人在所述约束力的作用下避开所述奇异位形继续运动。
结合第一方面,本发明实施例提供了第一方面的第一种可能的实施方式,其中,在使所述目标机器人在所述约束力的作用下避开所述奇异位形继续运动之后,所述方法还包括:
判断所述力控牵引的过程是否结束;
如果所述力控牵引的过程未结束,则返回执行实时计算目标机器人的可操作性指标的步骤,直至所述力控牵引的过程结束。
结合第一方面,本发明实施例提供了第一方面的第二种可能的实施方式,其中,所述方法还包括:
如果确定得到所述目标机器人未接近所述奇异位形,则使所述目标机器人在所述操作者的力控牵引下继续运动,直至所述力控牵引的过程结束。
结合第一方面,本发明实施例提供了第一方面的第三种可能的实施方式,其中,实时计算目标机器人的可操作性指标包括:
结合第一方面,本发明实施例提供了第一方面的第四种可能的实施方式,其中,根据所述可操作性指标确定所述目标机器人是否接近奇异位形包括:
判断所述可操作性指标是否小于预设可操作性指标阈值;
如果所述可操作性指标小于所述预设可操作性指标阈值,则确定所述目标机器人接近所述奇异位形;
如果所述可操作性指标不小于所述预设可操作性指标阈值,则确定所述目标机器人未接近所述奇异位形。
结合第一方面,本发明实施例提供了第一方面的第五种可能的实施方式,其中,基于所述可操作性指标计算约束力包括:
计算添加预设速度后的新的关节位置,其中,所述预设速度为笛卡尔坐标系中的速度;
基于所述新的关节位置计算新的可操作性指标;
结合所述新的可操作性指标和所述可操作性指标计算可操作性指标的梯度;
根据所述可操作性指标的梯度确定所述约束力的方向和所述约束力的大小,其中,所述约束力的方向为使所述操作性指标变大的方向。
结合第一方面,本发明实施例提供了第一方面的第六种可能的实施方式,其中,结合所述新的可操作性指标和所述可操作性指标计算可操作性指标的梯度包括:
根据可操作性指标的梯度计算算式计算所述可操作性指标的梯度,其中,Δw±表示所述可操作性指标的梯度,w(qn±)表示所述新的可操作性指标,w(q)表示所述可操作性指标,V±表示所述预设速度,qn±表示所述新的关节位置,q表示关节位置。
结合第一方面,本发明实施例提供了第一方面的第七种可能的实施方式,其中,根据所述可操作性指标的梯度确定所述约束力的方向和所述约束力的大小包括:
在所述可操作性指标的梯度中确定最大梯度,其中,所述可操作性指标的梯度Δw±包括:Δw+和Δw-,Δw+与qn+对应,Δw-与qn-对应,qn+与V+对应,qn-与V-对应,V+和V-表示方向相反的预设速度;
将与所述最大梯度所对应的预设速度的方向作为所述约束力的方向;
根据约束力大小计算算式F=k(w)max(Δw±)计算所述约束力的大小,其中,k(w)为关于可操作性指标w(q)的参数,max(Δw±)表示所述最大梯度。
第二方面,本发明实施例还提供了一种机器人力控牵引过程中的避奇异装置,应用于控制器,所述装置包括:
第一计算模块,用于实时计算目标机器人的可操作性指标,其中,所述目标机器人为在笛卡尔空间中,***作者进行力控牵引的机器人;
确定模块,用于根据所述可操作性指标确定所述目标机器人是否接近奇异位形;
第二计算模块,如果确定得到所述目标机器人接近所述奇异位形,则基于所述可操作性指标计算约束力,并通过驱动器向所述目标机器人额外施加所述约束力,以使所述目标机器人在所述约束力的作用下避开所述奇异位形继续运动。
结合第二方面,本发明实施例提供了第二方面的第一种可能的实施方式,其中,所述装置还包括:
判断模块,用于判断所述力控牵引的过程是否结束;
返回执行模块,如果所述力控牵引的过程未结束,则返回执行实时计算目标机器人的可操作性指标的步骤,直至所述力控牵引的过程结束。
本发明实施例带来了以下有益效果:
在现有的机器人力控牵引过程中,操作者常常会将机器人牵引至奇异位形而导致机器人报警停机,影响了力控牵引的操作体验,降低了操作效率。与现有的机器人力控牵引相比,本发明的机器人力控牵引过程中的避奇异方法中,控制器能够实时计算目标机器人的可操作性指标,进而根据可操作性指标确定目标机器人是否接近奇异位形,如果目标机器人接近奇异位形,则基于操作性指标计算约束力,并通过驱动器向目标机器人额外施加约束力,使得目标机器人在约束力的作用下避开奇异位形继续进行力控牵引的操作。该方法在力控牵引的过程中,能够有效避免机器人到达奇异位形,使得力控牵引的过程能够连续不断进行,改善了力控牵引的操作体验,提高了力控牵引的操作效率,缓解了现有的机器人在进行力控牵引的过程中,因操作者将机器人牵引至奇异位形所导致的机器人报警停机,致使力控牵引操作效率低下,操作体验差的技术问题。
本发明的其他特征和优点将在随后的说明书中阐述,并且,部分地从说明书中变得显而易见,或者通过实施本发明而了解。本发明的目的和其他优点在说明书、权利要求书以及附图中所特别指出的结构来实现和获得。
为使本发明的上述目的、特征和优点能更明显易懂,下文特举较佳实施例,并配合所附附图,作详细说明如下。
附图说明
为了更清楚地说明本发明具体实施方式或现有技术中的技术方案,下面将对具体实施方式或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图是本发明的一些实施方式,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明实施例提供的一种机器人力控牵引过程中的避奇异方法的流程图;
图2为本发明实施例提供的另一种机器人力控牵引过程中的避奇异方法的流程图;
图3为本发明实施例提供的根据可操作性指标确定目标机器人是否接近奇异位形的方法流程图;
图4为本发明实施例提供的基于可操作性指标计算约束力的方法流程图;
图5为本发明实施例提供的k(w)和w(q)的关系曲线的示意图;
图6为本发明实施例提供的一种机器人力控牵引过程中的避奇异装置的功能模块图。
图标:
11-第一计算模块;12-确定模块;13-第二计算模块。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合附图对本发明的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
为便于对本实施例进行理解,首先对本发明实施例所公开的一种机器人力控牵引过程中的避奇异方法进行详细介绍。
实施例一:
一种机器人力控牵引过程中的避奇异方法,应用于控制器,参考图1,该方法包括:
S102、实时计算目标机器人的可操作性指标,其中,目标机器人为在笛卡尔空间中,***作者进行力控牵引的机器人;
在本发明实施例中,力控牵引的过程是在笛卡尔空间中进行的。具体的,力控牵引中,操作者抓住机器人的末端在笛卡尔空间中对机器人进行力控牵引的操作,而该机器人即为目标机器人。下文中再对计算可操作性指标的过程进行描述,在此不再赘述。
S104、根据可操作性指标确定目标机器人是否接近奇异位形;
在得到可操作性指标后,根据可操作性指标确定目标机器人是否接近奇异位形。下文中再对确定的过程进行具体介绍,在此不再赘述。
S106、如果确定得到目标机器人接近奇异位形,则基于可操作性指标计算约束力,并通过驱动器向目标机器人额外施加约束力,以使目标机器人在约束力的作用下避开奇异位形继续运动。
如果确定得到目标机器人接近奇异位形,则基于可操作性指标计算约束力,进而通过驱动器向目标机器人额外施加约束力,使得目标机器人在约束力的作用下避开奇异位形而继续进行牵引运动。确保了力控牵引的过程连续进行,提高了操作效率。
在现有的机器人力控牵引过程中,操作者常常会将机器人牵引至奇异位形而导致机器人报警停机,影响了力控牵引的操作体验,降低了操作效率。与现有的机器人力控牵引相比,本发明的机器人力控牵引过程中的避奇异方法中,控制器能够实时计算目标机器人的可操作性指标,进而根据可操作性指标确定目标机器人是否接近奇异位形,如果目标机器人接近奇异位形,则基于操作性指标计算约束力,并通过驱动器向目标机器人额外施加约束力,使得目标机器人在约束力的作用下避开奇异位形继续进行力控牵引的操作。该方法在力控牵引的过程中,能够有效避免机器人到达奇异位形,使得力控牵引的过程能够连续不断进行,改善了力控牵引的操作体验,提高了力控牵引的操作效率,缓解了现有的机器人在进行力控牵引的过程中,因操作者将机器人牵引至奇异位形所导致的机器人报警停机,致使力控牵引操作效率低下,操作体验差的技术问题。
上述内容对机器人力控牵引过程中的避奇异方法进行了部分内容的介绍下面对其它内容进行介绍。
可选地,参考图2,在使目标机器人在约束力的作用下避开奇异位形继续运动之后,该方法还包括:
S108、判断力控牵引的过程是否结束;
S110、如果力控牵引的过程未结束,则返回执行实时计算目标机器人的可操作性指标的步骤,直至力控牵引的过程结束。
可选地,参考图2,该方法还包括:
S112、如果确定得到目标机器人未接近奇异位形,则使目标机器人在操作者的力控牵引下继续运动,直至力控牵引的过程结束。
上述内容对整个力控牵引全过程中避奇异的方法进行了介绍,下面对其中涉及到的内容进行具体描述。
可选地,实时计算目标机器人的可操作性指标包括:
x表示目标机器人操作空间的位置,q表示目标机器人关节空间的位置(即关节位置)。雅克比矩阵实际上定义了操作空间的速度与关节空间的速度之间的映射关系。实际的,x为q的函数(函数关系为现有技术,在此不再赘述),所以雅克比矩阵J为关节位置q的函数,关节位置q可通过驱动器(即目标机器人中的电机)上的编码器测得。
上述内容介绍了计算可操作性指标的过程,下面对确定目标机器人是否接近奇异位形的过程进行详细描述。
可选地,参考图3,根据可操作性指标确定目标机器人是否接近奇异位形包括:
S301、判断可操作性指标是否小于预设可操作性指标阈值;
在本发明实施例中,是通过可操作性指标与预设可操作性指标阈值之间的大小关系确定目标机器人是否接近奇异位形的。
具体的,预设可操作性指标阈值wth的大小为0.02,当然,本发明实施例对预设可操作性指标阈值的大小不进行限制,也可取其它值,但其值接近于0。
S302、如果可操作性指标小于预设可操作性指标阈值,则确定目标机器人接近奇异位形;
S303、如果可操作性指标不小于预设可操作性指标阈值,则确定目标机器人未接近奇异位形。
下面对计算约束力的过程进行描述。
可选地,参考图4,基于可操作性指标计算约束力包括:
S401、计算添加预设速度后的新的关节位置,其中,预设速度为笛卡尔坐标系中的速度;
在目标机器人接近奇异位形时,控制器继续添加一个虚拟的预设速度。即分别在笛卡尔空间的X,Y,Z方向加一个预设速度V±(该预设速度是用于计算时添加的虚拟速度,其实际并没有加在目标机器人上)。
进而计算添加预设速度后的新的关节位置。具体的,先利用雅克比矩阵求解关节速度,得到关节速度为J-1V±,然后,在ΔT时间内对关节速度进行积分得到关节位置的偏移量,也就是J-1V±ΔT,最后在关节位置的偏移量基础上加上当前的关节位置,得到新的关节位置q+J-1V±ΔT。
综上,新的关节位置qn±=q+J-1V±ΔT。
其中,qn+=q+J-1V+ΔT,qn-=q+J-1V-ΔT。也就是,qn+为预设速度V+对应的新的关节位置,qn-为预设速度V-对应的新的关节位置。预设速度V+和V-为方向相反的两个预设速度。
S402、基于新的关节位置计算新的可操作性指标;
在得到新的关节位置后,基于新的关节位置计算新的可操作性指标。具体计算过程与可操作性指标的计算过程相同,在此不再赘述。
S403、结合新的可操作性指标和可操作性指标计算可操作性指标的梯度;
具体的,根据可操作性指标的梯度计算算式计算可操作性指标的梯度,其中,Δw±表示可操作性指标的梯度,w(qn±)表示新的可操作性指标,w(q)表示可操作性指标,V±表示预设速度,qn±表示新的关节位置,q表示关节位置。
S404、根据可操作性指标的梯度确定约束力的方向和约束力的大小,其中,约束力的方向为使操作性指标变大的方向。
具体的,(1)在可操作性指标的梯度中确定最大梯度,其中,可操作性指标的梯度Δw±包括:Δw+和Δw-,Δw+与qn+对应,Δw-与qn-对应,qn+与V+对应,qn-与V-对应,V+和V-表示方向相反的预设速度;
(2)将与最大梯度所对应的预设速度的方向作为约束力的方向;
(3)根据约束力大小计算算式F=k(w)max(Δw±)计算约束力的大小,其中,k(w)为关于可操作性指标w(q)的参数,max(Δw±)表示最大梯度。
具体的,下面以一个举例进行说明:
以Y轴为例,假设预设速度为:Vy+=[0 +1 0 0 0 0]和Vy-=[0 -1 0 0 0 0],其中,上述预设速度的向量中,前3个元素分别对应X、Y、Z方向的平移速度,后3个元素分别对应X、Y、Z方向的转动速度。
在得到预设速度后对应的就能计算得到新的关节位置qn+和qn-,进而计算得到对应的新的可操作性指标Δw+和Δw-,进一步得到最大梯度max{Δw+,Δw-},将与最大梯度所对应的预设速度的方向作为约束力的方向,也就是如果最大梯度为Δw+,,则约束力的方向为Y轴的正方向;如果最大梯度为Δw-,则约束力的方向为Y轴的负方向,最后根据F=k(w)max(Δw±)计算约束力的大小。
本发明的机器人力控牵引过程中的避奇异方法中,当操作者在牵引示教过程中将机器人牵引至接近奇异位形的时候,控制器会检测到当前状态是接近奇异位形的,并控制机器人对操作者施加一定的约束力,防止操作者进一步将机器人牵引至奇异位形而导致报警停机,不会中断牵引操作过程,操作体验好,操作效率快。
实施例二:
一种机器人力控牵引过程中的避奇异装置,应用于控制器,参考图6,该装置包括:
第一计算模块11,用于实时计算目标机器人的可操作性指标,其中,目标机器人为在笛卡尔空间中,***作者进行力控牵引的机器人;
确定模块12,用于根据可操作性指标确定目标机器人是否接近奇异位形;
第二计算模块13,如果确定得到目标机器人接近奇异位形,则基于可操作性指标计算约束力,并通过驱动器向目标机器人额外施加约束力,以使目标机器人在约束力的作用下避开奇异位形继续运动。
本发明的机器人力控牵引过程中的避奇异装置中,控制器能够实时计算目标机器人的可操作性指标,进而根据可操作性指标确定目标机器人是否接近奇异位形,如果目标机器人接近奇异位形,则基于操作性指标计算约束力,并通过驱动器向目标机器人额外施加约束力,使得目标机器人在约束力的作用下避开奇异位形继续进行力控牵引的操作。该装置在力控牵引的过程中,能够有效避免机器人到达奇异位形,使得力控牵引的过程能够连续不断进行,改善了力控牵引的操作体验,提高了力控牵引的操作效率,缓解了现有的机器人在进行力控牵引的过程中,因操作者将机器人牵引至奇异位形所导致的机器人报警停机,致使力控牵引操作效率低下,操作体验差的技术问题。
可选地,该装置还包括:
判断模块,用于判断力控牵引的过程是否结束;
返回执行模块,如果力控牵引的过程未结束,则返回执行实时计算目标机器人的可操作性指标的步骤,直至力控牵引的过程结束。
可选地,该装置还包括:
继续运动模块,如果确定得到目标机器人未接近奇异位形,则使目标机器人在操作者的力控牵引下继续运动,直至力控牵引的过程结束。
可选地,第一计算模块包括:
可选地,确定模块包括:
判断单元,用于判断可操作性指标是否小于预设可操作性指标阈值;
第一确定单元,如果可操作性指标小于预设可操作性指标阈值,则确定目标机器人接近奇异位形;
第二确定单元,如果可操作性指标不小于预设可操作性指标阈值,则确定目标机器人未接近奇异位形。
可选地,第二计算模块包括:
第二计算单元,用于计算添加预设速度后的新的关节位置,其中,预设速度为笛卡尔坐标系中的速度;
第三计算单元,用于基于新的关节位置计算新的可操作性指标;
第四计算单元,用于结合新的可操作性指标和可操作性指标计算可操作性指标的梯度;
第三确定单元,用于根据可操作性指标的梯度确定约束力的方向和约束力的大小,其中,约束力的方向为使操作性指标变大的方向。
可选地,第四计算单元包括:
第一计算子单元,用于根据可操作性指标的梯度计算算式计算可操作性指标的梯度,其中,Δw±表示可操作性指标的梯度,w(qn±)表示新的可操作性指标,w(q)表示可操作性指标,V±表示预设速度,qn±表示新的关节位置,q表示关节位置。
可选地,第三确定单元包括:
确定子单元,用于在可操作性指标的梯度中确定最大梯度,其中,可操作性指标的梯度Δw±包括:Δw+和Δw-,Δw+与qn+对应,Δw-与qn-对应,qn+与V+对应,qn-与V-对应,V+和V-表示方向相反的预设速度;
设定子单元,用于将与最大梯度所对应的预设速度的方向作为约束力的方向;
第二计算子单元,用于根据约束力大小计算算式F=k(w)max(Δw±)计算约束力的大小,其中,k(w)为关于可操作性指标w(q)的参数,max(Δw±)表示最大梯度。
该实施例二中的具体内容可以参考上述实施例一中的描述,在此不再赘述。
本发明实施例所提供的机器人力控牵引过程中的避奇异方法及装置的计算机程序产品,包括存储了程序代码的计算机可读存储介质,所述程序代码包括的指令可用于执行前面方法实施例中所述的方法,具体实现可参见方法实施例,在此不再赘述。
所属领域的技术人员可以清楚地了解到,为描述的方便和简洁,上述描述的***和装置的具体工作过程,可以参考前述方法实施例中的对应过程,在此不再赘述。
另外,在本发明实施例的描述中,除非另有明确的规定和限定,术语“安装”、“相连”、“连接”应做广义理解,例如,可以是固定连接,也可以是可拆卸连接,或一体地连接;可以是机械连接,也可以是电连接;可以是直接相连,也可以通过中间媒介间接相连,可以是两个元件内部的连通。对于本领域的普通技术人员而言,可以具体情况理解上述术语在本发明中的具体含义。
所述功能如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本发明的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本发明各个实施例所述方法的全部或部分步骤。而前述的存储介质包括:U盘、移动硬盘、只读存储器(ROM,Read-Only Memory)、随机存取存储器(RAM,Random Access Memory)、磁碟或者光盘等各种可以存储程序代码的介质。
在本发明的描述中,需要说明的是,术语“中心”、“上”、“下”、“左”、“右”、“竖直”、“水平”、“内”、“外”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。此外,术语“第一”、“第二”、“第三”仅用于描述目的,而不能理解为指示或暗示相对重要性。
最后应说明的是:以上所述实施例,仅为本发明的具体实施方式,用以说明本发明的技术方案,而非对其限制,本发明的保护范围并不局限于此,尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,其依然可以对前述实施例所记载的技术方案进行修改或可轻易想到变化,或者对其中部分技术特征进行等同替换;而这些修改、变化或者替换,并不使相应技术方案的本质脱离本发明实施例技术方案的精神和范围,都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应所述以权利要求的保护范围为准。
Claims (9)
1.一种机器人力控牵引过程中的避奇异方法,其特征在于,应用于控制器,所述方法包括:
实时计算目标机器人的可操作性指标,其中,所述目标机器人为在笛卡尔空间中,***作者进行力控牵引的机器人;
根据所述可操作性指标确定所述目标机器人是否接近奇异位形;
如果确定得到所述目标机器人接近所述奇异位形,则基于所述可操作性指标计算约束力,并通过驱动器向所述目标机器人额外施加所述约束力,以使所述目标机器人在所述约束力的作用下避开所述奇异位形继续运动;
实时计算目标机器人的可操作性指标包括:
2.根据权利要求1所述的方法,其特征在于,在使所述目标机器人在所述约束力的作用下避开所述奇异位形继续运动之后,所述方法还包括:
判断所述力控牵引的过程是否结束;
如果所述力控牵引的过程未结束,则返回执行实时计算目标机器人的可操作性指标的步骤,直至所述力控牵引的过程结束。
3.根据权利要求1所述的方法,其特征在于,所述方法还包括:
如果确定得到所述目标机器人未接近所述奇异位形,则使所述目标机器人在所述操作者的力控牵引下继续运动,直至所述力控牵引的过程结束。
4.根据权利要求1所述的方法,其特征在于,根据所述可操作性指标确定所述目标机器人是否接近奇异位形包括:
判断所述可操作性指标是否小于预设可操作性指标阈值;
如果所述可操作性指标小于所述预设可操作性指标阈值,则确定所述目标机器人接近所述奇异位形;
如果所述可操作性指标不小于所述预设可操作性指标阈值,则确定所述目标机器人未接近所述奇异位形。
5.根据权利要求1所述的方法,其特征在于,基于所述可操作性指标计算约束力包括:
计算添加预设速度后的新的关节位置,其中,所述预设速度为笛卡尔坐标系中的速度;
基于所述新的关节位置计算新的可操作性指标;
结合所述新的可操作性指标和所述可操作性指标计算可操作性指标的梯度;
根据所述可操作性指标的梯度确定所述约束力的方向和所述约束力的大小,其中,所述约束力的方向为使所述操作性指标变大的方向。
7.根据权利要求6所述的方法,其特征在于,根据所述可操作性指标的梯度确定所述约束力的方向和所述约束力的大小包括:
在所述可操作性指标的梯度中确定最大梯度,其中,所述可操作性指标的梯度Δw±包括:Δw+和Δw-,Δw+与qn+对应,Δw-与qn-对应,qn+与V+对应,qn-与V-对应,V+和V-表示方向相反的预设速度;
将与所述最大梯度所对应的预设速度的方向作为所述约束力的方向;
根据约束力大小计算算式F=k(w)max(Δw±)计算所述约束力的大小,其中,k(w)为关于可操作性指标w(q)的参数,max(Δw±)表示所述最大梯度。
8.一种机器人力控牵引过程中的避奇异装置,其特征在于,应用于控制器,所述装置包括:
第一计算模块,用于实时计算目标机器人的可操作性指标,其中,所述目标机器人为在笛卡尔空间中,***作者进行力控牵引的机器人;
确定模块,用于根据所述可操作性指标确定所述目标机器人是否接近奇异位形;
第二计算模块,如果确定得到所述目标机器人接近所述奇异位形,则基于所述可操作性指标计算约束力,并通过驱动器向所述目标机器人额外施加所述约束力,以使所述目标机器人在所述约束力的作用下避开所述奇异位形继续运动;
9.根据权利要求8所述的装置,其特征在于,所述装置还包括:
判断模块,用于判断所述力控牵引的过程是否结束;
返回执行模块,如果所述力控牵引的过程未结束,则返回执行实时计算目标机器人的可操作性指标的步骤,直至所述力控牵引的过程结束。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810569295.2A CN108608427B (zh) | 2018-06-05 | 2018-06-05 | 机器人力控牵引过程中的避奇异方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810569295.2A CN108608427B (zh) | 2018-06-05 | 2018-06-05 | 机器人力控牵引过程中的避奇异方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108608427A CN108608427A (zh) | 2018-10-02 |
CN108608427B true CN108608427B (zh) | 2021-02-09 |
Family
ID=63664691
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810569295.2A Active CN108608427B (zh) | 2018-06-05 | 2018-06-05 | 机器人力控牵引过程中的避奇异方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108608427B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110989585B (zh) * | 2019-11-28 | 2024-02-02 | 深圳市优必选科技股份有限公司 | 避奇异的步态规划方法、装置、可读存储介质及机器人 |
CN110977974B (zh) * | 2019-12-11 | 2021-06-01 | 遨博(北京)智能科技有限公司 | 一种机器人规避奇异位型的导纳控制方法、装置及*** |
CN113021347A (zh) * | 2021-03-23 | 2021-06-25 | 深圳市优必选科技股份有限公司 | 机械臂控制方法、装置、作业控制设备及可读存储介质 |
CN114260896B (zh) * | 2021-12-20 | 2024-01-09 | 广东省科学院智能制造研究所 | 一种协作机器人的柔顺力控制方法及*** |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104029203B (zh) * | 2014-06-18 | 2017-07-18 | 大连大学 | 实现空间机械臂避障的路径规划方法 |
CN105415363B (zh) * | 2015-12-23 | 2017-11-17 | 珠海格力电器股份有限公司 | 机器人奇异点处理方法 |
CN107234617B (zh) * | 2017-07-10 | 2020-04-28 | 北京邮电大学 | 一种避障任务无关人工势场引导的避障路径规划方法 |
-
2018
- 2018-06-05 CN CN201810569295.2A patent/CN108608427B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN108608427A (zh) | 2018-10-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108608427B (zh) | 机器人力控牵引过程中的避奇异方法及装置 | |
AU2016309788B2 (en) | Steering and traction applications for determining a steering control attribute and a traction control attribute | |
JP3923053B2 (ja) | ロボット教示装置 | |
JP5750657B2 (ja) | 強化学習装置、制御装置、および強化学習方法 | |
AU2016309710B2 (en) | Model based diagnostics based on steering model | |
US20120185099A1 (en) | Telematic interface with control signal scaling based on force sensor feedback | |
CN113334392B (zh) | 一种机械臂防碰撞方法、装置、机器人及存储介质 | |
JP5733516B2 (ja) | 移動体把持装置と方法 | |
CN114603554A (zh) | 机器人负载转动惯量的标定方法、装置及存储介质 | |
JP5803178B2 (ja) | ロボットの制御方法およびロボットの制御装置 | |
CN113084828A (zh) | 一种运动控制方法、装置、设备和存储介质 | |
CN115958595A (zh) | 机械臂引导方法、装置、计算机设备和存储介质 | |
CN117723207A (zh) | 一种物体质心测量方法及相关设备 | |
CN114234903A (zh) | 安装角度的检测方法、振动检测方法以及检测*** | |
CN116985184A (zh) | 基于模型预测的机器人自碰撞检测方法、***及机器人 | |
CN117693418A (zh) | 控制装置、控制方法以及控制程序 |
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 |