CN105437235A - 一种奇异点区域减速保护方法、***和工业机器人 - Google Patents
一种奇异点区域减速保护方法、***和工业机器人 Download PDFInfo
- Publication number
- CN105437235A CN105437235A CN201610052294.1A CN201610052294A CN105437235A CN 105437235 A CN105437235 A CN 105437235A CN 201610052294 A CN201610052294 A CN 201610052294A CN 105437235 A CN105437235 A CN 105437235A
- Authority
- CN
- China
- Prior art keywords
- time
- real
- joint
- singular point
- target
- 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
Links
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
-
- 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/08—Programme-controlled manipulators characterised by modular constructions
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
本申请公开了一种奇异点区域减速保护方法、***和工业机器人,该方法和***应用于具有多个关节的工业机器人,具体为根据工业机器人的关节的实时状态数据和目标状态数据计算该关节的目标运动速度,实时状态数据包括关节的实时运动角度和实时时间,目标状态数据包括预设的运动任务所对应的目标运动角度和目标运动时间;然后在所述关节的位置处于奇异点过渡区域内时,计算关节的允许位置和允许速度;最后根据目标运动速度和允许速度对关节进行减速保护,即当关节的运动速度在奇异点过渡区域内的运动速度超出允许速度后及时控制器进行减速,以避免超速的发生,从而能够解决工业机器人因为在奇异点区域因速度变大而导致的停机或生产安全的问题。
Description
技术领域
本申请涉及机器人技术领域,更具体地说,涉及一种奇异点区域减速保护方法、***和工业机器人。
背景技术
工业机器人是工业自动化***中重要的部件之一,当前,多个国家在工业机器人技术上已经树立了一定的领先优势,尤其是在机器人本体的设计上,相关的基础技术已经比较成熟,因而众多的机器人厂家在机器人应用上投入了大量精力。对工业机器人的奇异点处理方法是机器人应用技术中一个主要的技术难点,是工业机器人必然遇到的技术问题,工业机器人一旦遇到或接近奇异点,就会发生关节运动速度变大的现象,从而导致机器人停机甚至带来生产安全问题。
发明内容
有鉴于此,本申请提供一种奇异点区域减速保护方法、***和工业机器人,用于解决工业机器人因为在奇异点区域因速度变大导致停机或生产安全的问题。
为了实现上述目的,现提出的方案如下:
一种奇异点区域减速保护方法,应用于具有多个关节的工业机器人,包括步骤:
根据所述工业机器人的关节的实时状态数据和目标状态数据计算所述关节的目标运动速度,所述实时状态数据包括所述关节的实时运动角度和实时时间,所述目标状态数据包括预设的运动任务所对应的目标运动角度和目标运动时间;
当所述关节的位置处于奇异点过渡区域内时,计算所述关节的允许速度;
根据所述目标运动速度和所述允许速度对所述关节进行减速保护。
可选的,所述根据所述工业机器人的关节的实时状态数据和目标状态数据计算所述关节的目标运动速度,包括:
获取所述实时运动角度和所述实时时间;
根据所述实时运动角度、所述实时时间、所述目标运动角度和所述目标运动时间计算所述目标运动速度。
可选的,所述根据所述实时运动角度、所述实时时间、所述目标运动角度和所述目标运动时间计算所述目标运动速度,包括:
根据所述运动任务计算所述关节的目标位置和目标姿态;
根据所述目标位置和目标姿态计算出所述目标运动角度和所述目标运动时间;
根据所述实时运动角度、所述实时时间、所述目标运动角度和所述目标运动时间计算所述目标运动速度。
可选的,所述根据所述工业机器人的关节的实时状态数据和目标状态数据计算所述关节的目标运动速度,还包括:
当所述关节的运动速度和位置处于异常状态时发出预设的控制指令。
可选的,所述当所述关节的运动速度和位置处于异常状态时发出预设的控制指令,包括:
当所述运动速度超出预设的速度阈值时发出第一控制指令,所述第一控制指令用于控制所述工业机器人停机;
当所述工业机器人的末端的位置超出正常工作区域时发出第二控制指令,所述第二控制指令用于控制所述工业机器人停机;
根据对所述工业机器人的运动位置的判断发出运动状态提示信息。
一种奇异点区域减速保护***,应用于具有多个关节的工业机器人,包括:
实时检测模块,用于根据所述工业机器人的关节的实时状态数据和目标状态数据计算所述关节的目标运动速度,所述实时状态数据包括所述关节的实时运动角度和实时时间,所述目标状态数据包括预设的运动任务所对应的目标运动角度和目标运动时间;
奇异点区域计算模块,用于当所述关节的位置处于奇异点过渡区域内时,计算所述关节的允许速度;
奇异点处理模块,用于根据所述目标运动速度和所述允许速度对所述关节进行减速保护。
可选的,所述实时检测模块包括:
本体信息单元,用于获取所述实时运动角度和所述实时时间;
模型处理单元,用于根据所述实时运动角度、所述实时时间、所述目标运动角度和所述目标运动时间计算所述目标运动速度。
可选的,所述模型处理单元包括:
正逆解子单元,用于根据所述运动任务计算所述关节的目标位置和目标姿态,并根据所述目标位置和目标姿态计算出所述目标运动角度和所述目标运动时间;
速度计算子单元,用于根据所述实时运动角度、所述实时时间、所述目标运动角度和所述目标运动时间计算所述目标运动速度。
可选的,所述实时检测模块还包括:
警报单元,用于当所述关节的运动速度和位置处于异常状态时发出预设的控制指令。
可选的,所述警报单元包括:
超速警报子单元,用于当所述运动速度超出预设的速度阈值时发出第一控制指令,所述第一控制指令用于控制所述工业机器人停机;
工作区域警报子单元,用当所述工业机器人的末端的位置超出正常工作区域时发出第二控制指令,所述第二控制指令用于控制所述工业机器人停机;
奇异点区域警报子单元,用于根据对所述工业机器人的运动位置的判断发出运动状态提示信息。
一种工业机器人,设置有如上所述的奇异点区域减速保护***。
从上述的技术方案可以看出,本申请公开了一种奇异点区域减速保护方法、***和工业机器人,该方法和***应用于具有多个关节的工业机器人,具体为根据工业机器人的关节的实时状态数据和目标状态数据计算该关节的目标运动速度,实时状态数据包括关节的实时运动角度和实时时间,目标状态数据包括预设的运动任务所对应的目标运动角度和目标运动时间;然后在所述关节的位置处于奇异点过渡区域内时,计算关节的允许位置和允许速度;最后根据目标运动速度和允许速度对关节进行减速保护,即当关节的运动速度在奇异点过渡区域内的运动速度超出允许速度后及时控制器进行减速,以避免超速的发生,从而能够解决工业机器人因为在奇异点区域因速度变大而导致的停机或生产安全的问题。
附图说明
为了更清楚地说明本申请实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本申请实施例提供的一种奇异点区域减速保护方法的流程图
图2为本申请提供的一种工业机器人的D-H模型示意图;
图3为本申请另一实施例提供的一种奇异点区域减速保护***的结构框图;
图4为本申请例提供另一种奇异点区域减速保护***的结构框图;
图5为本申请例提供又一种奇异点区域减速保护***的结构框图。
具体实施方式
下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。
实施例一
图1为本申请实施例提供的一种奇异点区域减速保护方法的流程图。
如图1所示,本实施例提供的奇异点区域减速保护方法应用于具有多个关节的工业机器人,为了方便描述,本实施例所选用的工业机器人具有6个关节。
工业机器人通常是用D-H模型进行机器人的结构建模,如图2所示,每两个关节之间的位置及姿态变换都可以使用四个参数的D-H矩阵进行模拟计算。最常见的6关节的工业机器人结构可以用六个D-H关节变换矩阵来表示,分别为:
其中,ci=cos(θi),si=sin(θi),i=1,2,...,5,6,θi为第i关节的关节转动角度,ai为关节i到关节i+1之间的连杆长度,di为关节i-1到关节i之间的连杆偏距。
通过计算矩阵乘法可以得到机器人基座到机器人末端的变换矩阵:
基于上述分析,本实施例提供的奇异点区域减速保护方法包括下列步骤:
S101:根据工业机器人的关节的实时状态数据和目标状态数据计算关节的目标运动速度。
其中实时状态数据包括关节的实时运动角度和实时时间,目标状态数据包括预设的运动任务所对应的目标运动角度和目标运动时间。目标运动速度的计算过程包括:
步骤1:获取机器人关节的实时关节转动角度θi以及实时时间t。
步骤2:将运动任务的目标位置和目标姿态采用封闭形式解法进行计算,解出关节需要转动的目标运动角度θ'i,并根据插补时间计算出运动任务的目标运动时间t'。然根据后关节的实时运动角度θi以及需要转动的目标运动角度θ'i,实时时间t以及运动任务的目标运动时间t',求解出运动任务的关节的目标运动速度:
S102:当关节的位置处于奇异点过渡区域内时,计算关节的允许速度。
首先,采用DLS(阻尼最小方差)算法进行奇异值控制:
J'=JT(JJT+ρ2I)-1
其中,J为机器人雅克比矩阵,J'为加入阻尼因子后的雅克比矩阵,ρ2为阻尼因子。
对阻尼因子的控制中加入奇异值控制:
其中,δ为雅克比矩阵J的最小奇异值,ε为δ的最大阈值。
当Tw2≤|θ5|<Tw1时,设定运动速度阈值k。
计算机器人在阈值Tw1处的运动速度作为运动速度最大值然后对阈值Tw1处的运动速度进行归一化处理,未使用减速算法的运动速度与使用减速算法的运动速度之比为
使用关节5角度值作为减速算法的变量,计算得到的距离变量为
经过减速算法修正过后的关节的允许速度为:
S103:根据目标运动速度和允许速度对关节进行减速保护。
当关节为执行运动任务而达到的目标运动速度超出允许速度时,及时控制该关节降低速度,使之不超出允许速度,从而避免出现超速。
从上述技术方案可以看出,本实施例提供了一种奇异点区域减速保护方法,该方法应用于具有多个关节的工业机器人,具体为根据工业机器人的关节的实时状态数据和目标状态数据计算该关节的目标运动速度,实时状态数据包括关节的实时运动角度和实时时间,目标状态数据包括预设的运动任务所对应的目标运动角度和目标运动时间;然后在关节的位置处于奇异点过渡区域内时,计算关节的允许位置和允许速度;最后根据目标运动速度和允许速度对关节进行减速保护,即当关节的运动速度在奇异点过渡区域内的运动速度超出允许速度后及时控制器进行减速,以避免超速的发生,从而能够解决工业机器人因为在奇异点区域因速度变大而导致的停机或生产安全的问题。
本实施例中的根据工业机器人的关节的实时状态数据和目标状态数据计算关节的目标运动速度的过程中,还包括步骤3,该步骤为警报步骤,用于在工业机器人的关节的运动速度和位置处于异常状态时发出预设的控制指令。
首先,针对6个关节的运动速度分别选取阈值Ti,i=1,2,...,5,6,进行判断:
对flagi的值件检测,当flagi=0时,机器人运动超速,设备发出第一控制指令,该第一控制指令用于控制工业机器人停机。
同时,设定机器人的工作区域zone,然后对工业机器人的末端的位置p(x,y,z)进行工作区域判断。
对flagzone的值进行检测,当flagzone=0时,机器人超出正常工作区域,这时发出第二控制指令,该第二控制指令同样用于控制工业机器人停机,以避免因超出正常工作区域造成安全事故。
最后,还对工业机器人的关节信号进行阈值判断,首先获得腕部奇异点判断值θ5。针对奇异点分别选取奇异点阈值Tw,那么进行判断:
对flagw的值进行检测,当flagw为0时此时,机器人运动至奇异点过渡区域,设备发出奇异点过渡警报信息;当flagw为1时此时,机器人运动至奇异点减速区域,设备发出奇异点减速警报信息。当flagw为2时此时,机器人正常运动。
实施例二
图3为本申请实施例提供的一种奇异点区域减速保护***的结构框图。
如图3所示,本实施例提供的奇异点区域减速保护***应用于具有多个关节的工业机器人,同样为了方便描述,本实施例所选用的工业机器人具有6个关节,该***包括实时检测模块10、奇异点区域计算模块20和奇异点处理模块30。
实时检测模块10用于根据工业机器人的关节的实时状态数据和目标状态数据计算关节的目标运动速度。
其中实时状态数据包括关节的实时运动角度和实时时间,目标状态数据包括预设的运动任务所对应的目标运动角度和目标运动时间。实时检测模块10包括本体信息单元11和模型处理单元12,如图4所示。
本体信息单元11用于获取机器人关节的实时关节转动角度θi以及实时时间t。
模型处理单元12包括正逆解子单元121和速度计算子单元122。
正逆解子单元121用于将运动任务的目标位置和目标姿态采用封闭形式解法进行计算,解出关节需要转动的目标运动角度θ'i,并根据插补时间计算出运动任务的目标运动时间t′。
速度计算子单元122用于根据关节的实时运动角度θi以及需要转动的目标运动角度θ'i,实时时间t以及运动任务的目标运动时间t',求解出运动任务的关节的目标运动速度:
奇异点区域计算模块20用于当关节的位置处于奇异点过渡区域内时,计算关节的允许速度。
首先,采用DLS(阻尼最小方差)算法进行奇异值控制:
J'=JT(JJT+ρ2I)-1
其中,J为机器人雅克比矩阵,J'为加入阻尼因子后的雅克比矩阵,ρ2为阻尼因子。
对阻尼因子的控制中加入奇异值控制:
其中,δ为雅克比矩阵J的最小奇异值,ε为δ的最大阈值。
当Tw2≤|θ5|<Tw1时,设定运动速度阈值k。
计算机器人在阈值Tw1处的运动速度作为运动速度最大值然后对阈值Tw1处的运动速度进行归一化处理,未使用减速算法的运动速度与使用减速算法的运动速度之比为
使用关节5角度值作为减速算法的变量,计算得到的距离变量为
经过减速算法修正过后的关节的允许速度为:
奇异点处理模块30用于根据目标运动速度和允许速度对关节进行减速保护。
当关节为执行运动任务而达到的目标运动速度超出允许速度时,及时控制该关节降低速度,使之不超出允许速度,从而避免出现超速。
从上述技术方案可以看出,本实施例提供了一种奇异点区域减速保护***,该***应用于具有多个关节的工业机器人,具体为根据工业机器人的关节的实时状态数据和目标状态数据计算该关节的目标运动速度,实时状态数据包括关节的实时运动角度和实时时间,目标状态数据包括预设的运动任务所对应的目标运动角度和目标运动时间;然后在关节的位置处于奇异点过渡区域内时,计算关节的允许位置和允许速度;最后根据目标运动速度和允许速度对关节进行减速保护,即当关节的运动速度在奇异点过渡区域内的运动速度超出允许速度后及时控制器进行减速,以避免超速的发生,从而能够解决工业机器人因为在奇异点区域因速度变大而导致的停机或生产安全的问题。
本实施例中的实时检测模块10中还包括警报单元13,该警报单元用于在工业机器人的关节的运动速度和位置处于异常状态时发出预设的控制指令,具体包括超速警报子单元131、工作区域警报子单元132和奇异点区域警报子单元133,如图5所示。
超速警报子单元131针对6个关节的运动速度分别选取阈值Ti,i=1,2,...,5,6,进行判断:
然后对flagi的值件检测,当flagi=0时,机器人运动超速,发出第一控制指令,该第一控制指令用于控制工业机器人停机。
工作区域警报子单元132用于设定机器人的工作区域zone,然后对工业机器人的末端的位置p(x,y,z)进行工作区域判断。
对flagzone的值进行检测,当flagzone=0时,机器人超出正常工作区域,这时发出第二控制指令,该第二控制指令同样用于控制工业机器人停机,以避免因超出正常工作区域造成安全事故。
奇异点区域警报子单元133用于对工业机器人的关节信号进行阈值判断,首先获得腕部奇异点判断值θ5。针对奇异点分别选取奇异点阈值Tw进行判断:
对flagw的值进行检测,当flagw为0时此时,机器人运动至奇异点过渡区域,设备发出奇异点过渡警报信息;当flagw为1时此时,机器人运动至奇异点减速区域,设备发出奇异点减速警报信息。当flagw为2时此时,机器人正常运动。
实施例三
本申请还提供了一种工业机器人,该工业机器人设置有上面实施例所提供的奇异点区域减速保护***,用于使该工业机器人在奇异点区域不会出现超速现象,能够避免因超速出现的停机或者安全事故。
本说明书中各个实施例采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似部分互相参见即可。对所公开的实施例的上述说明,使本领域专业技术人员能够实现或使用本申请。对这些实施例的多种修改对本领域的专业技术人员来说将是显而易见的,本文中所定义的一般原理可以在不脱离本申请的精神或范围的情况下,在其它实施例中实现。因此,本申请将不会被限制于本文所示的这些实施例,而是要符合与本文所公开的原理和新颖特点相一致的最宽的范围。
Claims (11)
1.一种奇异点区域减速保护方法,应用于具有多个关节的工业机器人,其特征在于,包括:
根据所述工业机器人的关节的实时状态数据和目标状态数据计算所述关节的目标运动速度,所述实时状态数据包括所述关节的实时运动角度和实时时间,所述目标状态数据包括预设的运动任务所对应的目标运动角度和目标运动时间;
当所述关节的位置处于奇异点过渡区域内时,计算所述关节的允许速度;
根据所述目标运动速度、所述允许速度对所述关节进行减速保护。
2.如权利要求1所述的奇异点区域减速保护方法,其特征在于,所述根据所述工业机器人的关节的实时状态数据和目标状态数据计算所述关节的目标运动速度,包括:
获取所述实时运动角度和所述实时时间;
根据所述实时运动角度、所述实时时间、所述目标运动角度和所述目标运动时间计算所述目标运动速度。
3.如权利要求2所述的奇异点区域减速保护方法,其特征在于,所述根据所述实时运动角度、所述实时时间、所述目标运动角度和所述目标运动时间计算所述目标运动速度,包括:
根据所述运动任务计算所述关节的目标位置和目标姿态;
根据所述目标位置和目标姿态计算出所述目标运动角度和所述目标运动时间;
根据所述实时运动角度、所述实时时间、所述目标运动角度和所述目标运动时间计算所述目标运动速度。
4.如权利要求2或3所述的奇异点区域减速保护方法,其特征在于,所述根据所述工业机器人的关节的实时状态数据和目标状态数据计算所述关节的目标运动速度,还包括:
当所述关节的运动速度和位置处于异常状态时发出预设的控制指令。
5.如权利要求4所述的奇异点区域减速保护方法,其特征在于,所述当所述关节的运动速度和位置处于异常状态时发出预设的控制指令,包括:
当所述运动速度超出预设的速度阈值时发出第一控制指令,所述第一控制指令用于控制所述工业机器人停机;
当所述工业机器人的末端的位置超出正常工作区域时发出第二控制指令,所述第二控制指令用于控制所述工业机器人停机;
根据对所述工业机器人的运动位置的判断发出运动状态提示信息。
6.一种奇异点区域减速保护***,应用于具有多个关节的工业机器人,其特征在于,包括:
实时检测模块,用于根据所述工业机器人的关节的实时状态数据和目标状态数据计算所述关节的目标运动速度,所述实时状态数据包括所述关节的实时运动角度和实时时间,所述目标状态数据包括预设的运动任务所对应的目标运动角度和目标运动时间;
奇异点区域计算模块,用于当所述关节的位置处于奇异点过渡区域内时,计算所述关节的允许速度;
奇异点处理模块,用于根据所述目标运动速度、所述所述允许速度对所述关节进行减速保护。
7.如权利要求6所述的奇异点区域减速保护***,其特征在于,所述实时检测模块包括:
本体信息单元,用于获取所述实时运动角度和所述实时时间;
模型处理单元,用于根据所述实时运动角度、所述实时时间、所述目标运动角度和所述目标运动时间计算所述目标运动速度。
8.如权利要求7所述的奇异点区域减速保护***,其特征在于,所述模型处理单元包括:
正逆解子单元,用于根据所述运动任务计算所述关节的目标位置和目标姿态,并根据所述目标位置和目标姿态计算出所述目标运动角度和所述目标运动时间;
速度计算子单元,用于根据所述实时运动角度、所述实时时间、所述目标运动角度和所述目标运动时间计算所述目标运动速度。
9.如权利要求7或8所述的奇异点区域减速保护***,其特征在于,所述实时检测模块还包括:
警报单元,用于当所述关节的运动速度和位置处于异常状态时发出预设的控制指令。
10.如权利要求9所述的奇异点区域减速保护***,其特征在于,所述警报单元包括:
超速警报子单元,用于当所述运动速度超出预设的速度阈值时发出第一控制指令,所述第一控制指令用于控制所述工业机器人停机;
工作区域警报子单元,用当所述工业机器人的末端的位置超出正常工作区域时发出第二控制指令,所述第二控制指令用于控制所述工业机器人停机;
奇异点区域警报子单元,用于根据对所述工业机器人的运动位置的判断发出运动状态提示信息。
11.一种工业机器人,其特征在于,设置有如权利要求6~10任一项所述的奇异点区域减速保护***。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610052294.1A CN105437235A (zh) | 2016-01-25 | 2016-01-25 | 一种奇异点区域减速保护方法、***和工业机器人 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610052294.1A CN105437235A (zh) | 2016-01-25 | 2016-01-25 | 一种奇异点区域减速保护方法、***和工业机器人 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN105437235A true CN105437235A (zh) | 2016-03-30 |
Family
ID=55548104
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610052294.1A Pending CN105437235A (zh) | 2016-01-25 | 2016-01-25 | 一种奇异点区域减速保护方法、***和工业机器人 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105437235A (zh) |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108363406A (zh) * | 2017-12-29 | 2018-08-03 | 易瓦特科技股份公司 | 无人机的控制方法及装置 |
CN108687758A (zh) * | 2017-04-11 | 2018-10-23 | 日本电产三协株式会社 | 机器人的移动速度控制装置及方法 |
CN109108987A (zh) * | 2018-11-09 | 2019-01-01 | 哈尔滨工业大学 | 一种基于EtherCAT的六轴机械臂安全限位方法 |
CN109571481A (zh) * | 2018-12-30 | 2019-04-05 | 深圳市越疆科技有限公司 | 一种关节奇异点处理方法、装置、设备和存储介质 |
CN109605369A (zh) * | 2018-12-07 | 2019-04-12 | 英华达(上海)科技有限公司 | 机械臂奇异点控制方法及*** |
CN110405749A (zh) * | 2018-04-27 | 2019-11-05 | 深圳市优必选科技有限公司 | 关节限位检测方法、装置、机器人及计算机可读存储介质 |
CN111152217A (zh) * | 2019-12-30 | 2020-05-15 | 深圳优地科技有限公司 | 一种速度控制方法、装置、机器人及存储介质 |
CN112621713A (zh) * | 2020-11-30 | 2021-04-09 | 珠海格力电器股份有限公司 | 机器人示教器、控制器及其示教、控制方法、装置和介质 |
CN112618020A (zh) * | 2020-12-15 | 2021-04-09 | 深圳市精锋医疗科技有限公司 | 手术机器人及其控制方法、控制装置 |
CN113771031A (zh) * | 2021-09-07 | 2021-12-10 | 苏州艾利特机器人有限公司 | 一种机器人自适应调速方法及多关节机器人 |
CN115179288A (zh) * | 2022-07-13 | 2022-10-14 | 安徽省配天机器人集团有限公司 | 机器人的运动学逆解方法、机器人及计算机可读存储介质 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH03170282A (ja) * | 1989-11-27 | 1991-07-23 | Matsushita Electric Ind Co Ltd | ロボットの制御方法 |
JP2003300183A (ja) * | 2002-04-09 | 2003-10-21 | Nippon Steel Corp | 垂直多関節型マニピュレータの制御装置 |
CN103009389A (zh) * | 2012-11-30 | 2013-04-03 | 北京控制工程研究所 | 一种冗余空间机械臂在轨抓捕的轨迹规划方法 |
-
2016
- 2016-01-25 CN CN201610052294.1A patent/CN105437235A/zh active Pending
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH03170282A (ja) * | 1989-11-27 | 1991-07-23 | Matsushita Electric Ind Co Ltd | ロボットの制御方法 |
JP2003300183A (ja) * | 2002-04-09 | 2003-10-21 | Nippon Steel Corp | 垂直多関節型マニピュレータの制御装置 |
CN103009389A (zh) * | 2012-11-30 | 2013-04-03 | 北京控制工程研究所 | 一种冗余空间机械臂在轨抓捕的轨迹规划方法 |
Non-Patent Citations (3)
Title |
---|
刘松国: "6R机器人实时逆运动学算法研究", 《控制理论与应用》 * |
朱向阳: "机器人运动学反解中的奇异点处理", 《机器人》 * |
王英石: "冗余机器人的运动学及轨迹规划的研究", 《中国优秀博士学位论文全文数据库 信息科技辑》 * |
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108687758A (zh) * | 2017-04-11 | 2018-10-23 | 日本电产三协株式会社 | 机器人的移动速度控制装置及方法 |
CN108687758B (zh) * | 2017-04-11 | 2022-04-05 | 日本电产三协株式会社 | 机器人的移动速度控制装置及方法 |
CN108363406A (zh) * | 2017-12-29 | 2018-08-03 | 易瓦特科技股份公司 | 无人机的控制方法及装置 |
CN110405749B (zh) * | 2018-04-27 | 2020-12-15 | 深圳市优必选科技有限公司 | 关节限位检测方法、装置、机器人及计算机可读存储介质 |
CN110405749A (zh) * | 2018-04-27 | 2019-11-05 | 深圳市优必选科技有限公司 | 关节限位检测方法、装置、机器人及计算机可读存储介质 |
CN109108987A (zh) * | 2018-11-09 | 2019-01-01 | 哈尔滨工业大学 | 一种基于EtherCAT的六轴机械臂安全限位方法 |
CN109605369A (zh) * | 2018-12-07 | 2019-04-12 | 英华达(上海)科技有限公司 | 机械臂奇异点控制方法及*** |
CN109605369B (zh) * | 2018-12-07 | 2021-09-07 | 英华达(上海)科技有限公司 | 机械臂奇异点控制方法及*** |
CN109571481A (zh) * | 2018-12-30 | 2019-04-05 | 深圳市越疆科技有限公司 | 一种关节奇异点处理方法、装置、设备和存储介质 |
CN111152217A (zh) * | 2019-12-30 | 2020-05-15 | 深圳优地科技有限公司 | 一种速度控制方法、装置、机器人及存储介质 |
CN112621713A (zh) * | 2020-11-30 | 2021-04-09 | 珠海格力电器股份有限公司 | 机器人示教器、控制器及其示教、控制方法、装置和介质 |
CN112618020A (zh) * | 2020-12-15 | 2021-04-09 | 深圳市精锋医疗科技有限公司 | 手术机器人及其控制方法、控制装置 |
CN113771031A (zh) * | 2021-09-07 | 2021-12-10 | 苏州艾利特机器人有限公司 | 一种机器人自适应调速方法及多关节机器人 |
WO2023036116A1 (zh) * | 2021-09-07 | 2023-03-16 | 苏州艾利特机器人有限公司 | 一种机器人自适应调速方法及多关节机器人 |
CN113771031B (zh) * | 2021-09-07 | 2023-11-28 | 苏州艾利特机器人有限公司 | 一种机器人自适应调速方法及多关节机器人 |
CN115179288A (zh) * | 2022-07-13 | 2022-10-14 | 安徽省配天机器人集团有限公司 | 机器人的运动学逆解方法、机器人及计算机可读存储介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105437235A (zh) | 一种奇异点区域减速保护方法、***和工业机器人 | |
CN205614678U (zh) | 一种奇异点区域减速保护***和工业机器人 | |
JP3223826U (ja) | 産業用ロボット | |
US9821459B2 (en) | Multi-joint robot having function for repositioning arm | |
US8112179B2 (en) | Multi-joint robot and control program thereof | |
EP3498433A1 (en) | Dynamical safety trajectories in a robotic system | |
JP6236388B2 (ja) | ロボット制御方法 | |
CN101332604A (zh) | 人机相互作用机械臂的控制方法 | |
Chen et al. | Trajectory planning in parallel kinematic manipulators using a constrained multi-objective evolutionary algorithm | |
JP2007222951A5 (zh) | ||
Date et al. | Control of 3D snake-like locomotive mechanism based on continuum modeling | |
TW202200332A (zh) | 計算自動化機器之安全範圍 | |
CN105537824A (zh) | 一种基于机械臂手眼协调自主焊接控制方法 | |
CN104999463B (zh) | 一种基于构形平面的冗余机械臂运动控制方法 | |
US20210347288A1 (en) | Crane, a vehicle, and a method of the crane | |
CN105437234A (zh) | 一种多奇异点处理方法、***和工业机器人 | |
Tourajizadeh et al. | Dynamic optimization of a steerable screw in-pipe inspection robot using HJB and turbine installation | |
CN105415363A (zh) | 位移装置、机器人及机器人奇异点处理方法 | |
Nie et al. | Design of Motion Control System for Fire Fighting Robot | |
CN205685337U (zh) | 一种多奇异点处理*** | |
Shang et al. | Synchronization control of a parallel manipulator with redundant actuation in the task space | |
Tao et al. | Optimization design of the multi-unit serial inspection robot for power transmission line | |
Zube et al. | Model predictive contact control for human-robot interaction | |
Phan et al. | Decentralized control design for welding mobile manipulator | |
Chen et al. | Backstepping-based hybrid target tracking control for a carangiform robotic fish |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20160330 |