CN106019942B - 一种基于动力学模型的机器人最大速度获取方法及系统 - Google Patents
一种基于动力学模型的机器人最大速度获取方法及系统 Download PDFInfo
- Publication number
- CN106019942B CN106019942B CN201610460754.4A CN201610460754A CN106019942B CN 106019942 B CN106019942 B CN 106019942B CN 201610460754 A CN201610460754 A CN 201610460754A CN 106019942 B CN106019942 B CN 106019942B
- Authority
- CN
- China
- Prior art keywords
- speed
- gain coefficient
- robot
- joint
- maximum
- 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.)
- Expired - Fee Related
Links
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
- Manipulator (AREA)
Abstract
一种基于动力学模型的机器人最大速度获取方法及系统,方法包括:S1、建立机器人的关节力矩与速度以及加速度之间的不显含重力、仅显含与位置相关的惯性力、离心力和科里奥利力的动力学模型:S2、根据设定的位置、速度以及加速度,计算每个采样周期的各关节的力矩τia(nT),且根据各关节力矩的力矩约束范围[τimin,τimax],计算得到各个关节的每个采样周期的速度增益系数λi(nT);S3、基于速度增益系数λi(nT)和电机最大允许速度计算机器人最大速度。本发明考虑了各关节力矩的力矩约束,使得求解的最大速度必为机器人最大可承受速度;所求取的最大速度,仅与机器人具体的运动轨迹有关,与先前的工作区域无关,提高了机器人的利用效率;进一步的,还可求取每个位置点可承受的最大速度。
Description
技术领域
本发明涉及机器人控制领域,尤其涉及一种基于动力学模型的机器人最大速度获取方法及系统。
背景技术
工业机器人在进行轨迹规划时,为使机器人工作效率最大化,需确定机器人的最大运行速度限制。目前机器人最大运行速度的限制主要有两个,即机器人关节最大速度限制和机器人末端最大速度限制。关节最大速度限制主要以最大关节速度为依据,或根据电机转速力矩曲线确定在满足输出转矩条件下的最大电机速度限制。机器人末端最大速度限制主要以机器人典型工作区间的最大速度为参考依据。
针对关节最大速度限制,由于机器人在不同位姿下,其实际可承受的最大关节速度不同,甚至会出现关节最大速度限制大于机器人实际可承受的最大关节速度,这势必引起机器人故障停机,造成机械本体的损坏。
针对末端最大速度,同样存在机器人末端最大速度与机器人位姿相关的问题。虽然可以通过雅克比矩阵建立机器人关节速度和机器人末端速度的映射关系,但如果单纯以最大关节速度计算最大末端速度,而不考虑机器人各关节实际输出力矩的限制,机器人可能因关节力矩超限而无法承受该最大速度。因此,在实际使用过程中,机器人最大末端速度主要以典型工作区域的最大速度为参考。为使机器人能在较大工作空间中正常运行,其典型工作区域需尽可能大。但工作区域越大,对应的可满足整个工作区域正常运行的最大速度限制也就越小,这将严重降低机器人的工作效率。
发明内容
本发明要解决的技术问题在于,针对现有技术的上述缺陷,提供一种基于动力学模型的机器人最大速度获取方法及系统。
本发明解决其技术问题所采用的技术方案是:构造一种基于动力学模型的机器人最大速度获取方法,包括以下步骤:
S1、建立机器人的关节力矩与速度以及加速度之间的不显含重力、仅显含与位置相关的惯性力、离心力和科里奥利力的动力学模型:
其中,τa(t)表示N×1的关节力矩向量,B(q(t))为N×N惯量矩阵,C(q(t),为N×N科里奥利力及离心力矩阵,N为机器人关节数,为加速度信息,为速度信息,q(t)为位置信息;
S2、根据设定的位置、速度以及加速度,计算每个采样周期的各关节的力矩τia(nT),且根据各关节力矩的力矩约束范围[τimin,τimax],计算得到各个关节的每个采样周期的速度增益系数λi(nT);
S3、基于步骤S2中的速度增益系数λi(nT)和电机最大允许速度计算获得机器人最大速度。
在本发明所述的基于动力学模型的机器人最大速度获取方法中,所述步骤S2中,通过以下公式计算得到各个关节的每个采样周期的速度增益系数λi(nT):
其中,τimin<0且τimax>0;n表示采样序号,n为大于等于0的正整数,i表示关节序号,i=1,2,...,N。
在本发明所述的基于动力学模型的机器人最大速度获取方法中,步骤S2力矩τia(nT)的计算包括:设定运动轨迹的起止位置、各关节运行速度的恒定值各关节加速度值为0、机器人采样周期为T,基于步骤S1中的所述动力学模型,计算得到对应于每个采样周期的各关节力矩为τia(nT)。
在本发明所述的基于动力学模型的机器人最大速度获取方法中,所述步骤S3包括:
S31、从所有的关节的所有的周期下的速度增益系数中筛选出最小的速度增益系数作为本次运动轨迹的速度增益系数:
S32、根据步骤S31选出的速度增益系数λ以及步骤S2中设定的运行速度计算得到适用于所有位置点的全局最大速度为并从和电机最大允许速度中选取最小值作为本次运动轨迹的最大速度
在本发明所述的基于动力学模型的机器人最大速度获取方法中,所述步骤S3包括:
S31’、从每个采样周期下的所有的关节的速度增益系数中筛选出最小的速度增益系数作为本次运动轨迹的每个位置点的速度增益系数:
λ(nT)=min{λ2 1(nT),λ2 2(nT),......,λ2 N(nT)}
S32’、根据步骤S31’选出的速度增益系数λ(nT)以及步骤S2中设定的运行速度计算得到某个位置点的局部最大速度为并从和电机最大允许速度中选取最小值作为本次运动轨迹的某个位置点的最大速度
本发明还公开了一种基于动力学模型的机器人最大速度获取系统,包括:
模型建立单元,用于建立机器人的关节力矩与速度以及加速度之间的不显含重力、仅显含与位置相关的惯性力、离心力和科里奥利力的动力学模型:
其中,τa(t)表示N×1的关节力矩向量,B(q(t))为N×N惯量矩阵,C(q(t),为N×N科里奥利力及离心力矩阵,N为机器人关节数,为加速度信息,为速度信息,q(t)为位置信息;
速度增益系数求解单元,根据设定的位置、速度以及加速度,计算每个采样周期的各关节的力矩τia(nT),且根据各关节力矩的力矩约束范围[τimin,τimax],计算得到各个关节的每个采样周期的速度增益系数λi(nT);
最大速度求解单元,基于速度增益系数求解单元中得到的速度增益系数λi(nT)和电机最大允许速度计算机器人最大速度。
在本发明所述的基于动力学模型的机器人最大速度获取系统中,所述速度增益系数求解单元通过以下公式计算得到各个关节的每个采样周期的速度增益系数λi(nT):
其中,τimin<0且τimax>0;n表示采样序号,n为大于等于0的正整数,i表示关节序号,i=1,2,...,N。
在本发明所述的基于动力学模型的机器人最大速度获取系统中,力矩τia(nT)的计算包括:设定运动轨迹的起止位置、各关节运行速度的恒定值各关节加速度值为0、机器人采样周期为T,基于所述动力学模型,计算得到对应于每个采样周期的各关节力矩为τia(nT)。
在本发明所述的基于动力学模型的机器人最大速度获取系统中,最大速度求解单元包括:
速度增益系数筛选子单元,从所有的关节的所有的周期下的速度增益系数中筛选出最小的速度增益系数作为本次运动轨迹的速度增益系数:
全局最大速度求解子单元,根据速度增益系数筛选子单元选出的速度增益系数λ以及速度增益系数求解单元中设定的运行速度计算得到适用于所有位置点的全局最大速度为并从和电机最大允许速度中选取最小值作为本次运动轨迹的最大速度
在本发明所述的基于动力学模型的机器人最大速度获取系统中,最大速度求解单元包括:
速度增益系数筛选子单元,从每个采样周期下的所有的关节的速度增益系数中筛选出最小的速度增益系数作为本次运动轨迹的每个位置点的速度增益系数:
λ(nT)=min{λ2 1(nT),λ2 2(nT),......,λ2 N(nT)}
局部最大速度求解子单元,根据速度增益系数筛选子单元选出的速度增益系数λ(nT)以及速度增益系数求解单元中设定的运行速度计算得到某个位置点的局部最大速度为并从和电机最大允许速度中选取最小值作为本次运动轨迹的某个位置点的最大速度
实施本发明的基于动力学模型的机器人最大速度获取方法及系统,具有以下有益效果:本发明基于动力学模型,考虑了各关节力矩的力矩约束,使得求解的最大速度必为机器人最大可承受速度;所求取的最大速度,仅与机器人具体的运动轨迹有关,与先前的工作区域无关,极大提高了机器人的利用效率;进一步的,本发明既可以求取机器人运动时适用于所有位置的最大速度,又可以求取机器人运动时每个位置点可承受的最大速度,其属于高级轨迹规划控制器变最大速度控制的关键参数,可最大化机器人工作效率。
附图说明
下面将结合附图及实施例对本发明作进一步说明,附图中:
图1是本发明的基于动力学模型的机器人最大速度获取方法的流程图;
图2为初始速度下机器人各关节力矩图;
图3为初始速度下各个位置点最大的λ允许值示意图;
图4为最大速度下机器人各关节力矩图。
具体实施方式
为了对本发明的技术特征、目的和效果有更加清楚的理解,现对照附图详细说明本发明的具体实施方式。
参考图1,是本发明的基于动力学模型的机器人最大速度获取方法的流程图。
本发明的基于动力学模型的机器人最大速度获取方法包括以下步骤:
S1、建立机器人的关节力矩与速度以及加速度之间的不显含重力、仅显含与位置相关的惯性力、离心力和科里奥利力的动力学模型:
其中,τa(t)表示N×1的关节力矩向量,B(q(t))为N×N惯量矩阵,为N×N科里奥利力及离心力矩阵,N为机器人关节数,为加速度信息,为速度信息,q(t)为位置信息;
S2、根据设定的位置、速度以及加速度,计算每个采样周期的各关节的力矩τia(nT),且根据各关节力矩的力矩约束范围[τimin,τimax],计算得到各个关节的每个采样周期的速度增益系数λi(nT);
S3、基于步骤S2中的速度增益系数λi(nT)和电机最大允许速度计算机器人最大速度。
下面详细介绍各个步骤。
关于步骤S1:
众所周知,具有标准形式的机器人动力学模型的表达式如下:
其中,τ表示N×1的关节力矩向量,B(q(t))为N×N惯量矩阵,C(q(t),为N×N科里奥利力及离心力矩阵,G(q(t))为N×1的重力向量,N为机器人关节数,为加速度信息,为速度信息,q(t)为位置信息;
步骤S1的动力学模型是对公式(1)的机器人标准动力学模型进行简单的数学变换,使力矩τa(t)仅与惯性力、科里奥利力、速度、加速度有关,而与重力无关,改写过程为:
关于步骤S2:
步骤S2中通过以下公式计算得到各个关节的每个采样周期的速度增益系数λi(nT):
其中,τimin<0且τimax>0;n表示采样序号,n为大于等于0的正整数,i表示关节序号,i=1,2,...,N。
其中,公式(B)的推导过程如下:
对公式(A)的动力学模型进行数学变换,假设s=λt,则:
将上面的公式(B1)和公式(B2)代入公式(A),则可以推导得到公式(C):
即,从公式(C)可以得到速度增益系数λ、力矩τa(t)、力矩τa(s)之间的关系如公式(D):
基于公式(D),我们把力矩τia(nT)作为公式(D)中的τa(s),各力矩约束范围作为公式(D)中的τa(t),于是可以计算得到各个关节的每个采样周期的速度增益系数。由于公式(D)中的λ2肯定大于等于0,又τimin<0且τimax>0,所以,在τia(nT)>0τia(nT)时,则选择τimax代入公式(D),在τia(nT)<0时,则选择τimin代入公式(D),于是可以得到上述的(B)。
从公式(A)可知,各关节力矩τa的计算依赖于速度、加速度以及位置,所以一个具体实施例中,步骤S2力矩τia(nT)的计算具体为:设定运动轨迹的起止位置、各关节运行速度的恒定值各关节加速度值为0、机器人采样周期为T,基于步骤S1中的所述动力学模型的公式(A),计算得到对应于每个采样周期的各关节力矩为τia(nT)。
关于步骤S3:
步骤S3求取的最大速度有两种,一种是适用于所有位置的全局最大速度,一种是针对每个位置的局部最大速度。
当求取全局最大速度时,所述步骤S3包括:
S31、从所有的关节的所有的周期下的速度增益系数中筛选出最小的速度增益系数作为本次运动轨迹的速度增益系数:
S32、根据步骤S31选出的速度增益系数λ以及步骤S2中设定的运行速度计算得到适用于所有位置点的全局最大速度为并从和电机最大允许速度中选取最小值作为本次运动轨迹的最大速度
当求取局部最大速度时,所述步骤S3包括:
S31’、从每个采样周期下的所有的关节的速度增益系数中筛选出最小的速度增益系数作为本次运动轨迹的每个位置点的速度增益系数:
λ(nT)=min{λ2 1(nT),λ2 2(nT),......,λ2 N(nT)}
S32’、根据步骤S31’选出的速度增益系数λ(nT)以及步骤S2中设定的运行速度计算得到某个位置点的局部最大速度为并从和电机最大允许速度中选取最小值作为本次运动轨迹的某个位置点的最大速度
下面结合具体的实施案例对本发明作进一步说明。
现以某SCARA机器人第一、二关节为最大速度求解实施对象,首先建立动力学模型如下:
其中,为第1,2连杆绕质心坐标系Z轴的转动惯量,为第1,2连杆质量(含电机等转配部件),a1,a2为第1,2连杆长度,l1,l2为第1,2连杆质心距离连杆起始处的长度,q1,q2,为第1,2连杆旋转的角度,速度及加速度,si,ci为第i个连杆位置的正余弦运算,τ1,τ2为第1,2连杆的力矩。
按照上述步骤S2,设定初始第一二关节起止位置为[-120,120]°,设定第一二关节速度均为600°/s,设置加速度为0,可得在该组轨迹参数下,各关节运动的力矩τia(nT)及速度曲线分别如图2所示。根据上述步骤S2设置第一二关节力矩限制均为[-63.5Nm,63.5Nm],可求得针对每一个位置点的可取的λ值并绘制成曲线如图3所示,该图中最小的被允许的λ值为1.7874,为说明本发明的有效性,此处暂不考虑电机最大转速,则最大速度为1.7874*600°/s=1072.4°/s,计算在上述最大速度运动情况下各关节力矩曲线如图4所示。
通过图4可以看出,当机器人以最大速度1072.4°/s运行时,第一关节电机实际输出转矩在某些位置可达最大关节电机输出扭矩,这说明此时机器人运行的速度确实是机器人最大可承受的速度;但在任何一个位置点,各关节实际输出扭矩均小于或等于最大关节扭矩限制值,这说明了机器人此速度下运行是切实可行的。以上两个方面证明了基于本发明所求解的最大速度在保证机器人正常运行的前提下,切实提高了机器人的利用效率。
相应的,本发明还公开了一种基于动力学模型的机器人最大速度获取系统,包括:
模型建立单元,用于建立机器人的关节力矩与速度以及加速度之间的不显含重力、仅显含与位置相关的惯性力、离心力和科里奥利力的动力学模型:
其中,τa(t)表示N×1的关节力矩向量,B(q(t))为N×N惯量矩阵,为N×N科里奥利力及离心力矩阵,N为机器人关节数,为加速度信息,为速度信息,q(t)为位置信息;
速度增益系数求解单元,根据设定的位置、速度以及加速度,计算每个采样周期的各关节的力矩τia(nT),且根据各关节力矩的力矩约束范围[τimin,τimax],计算得到各个关节的每个采样周期的速度增益系数λi(nT);
最大速度求解单元,基于速度增益系数求解单元中得到的速度增益系数λi(nT)和电机最大允许速度计算机器人最大速度。
其中,所述速度增益系数求解单元通过以下公式计算得到各个关节的每个采样周期的速度增益系数λi(nT):
其中,τimin<0且τimax>0;n表示采样序号,n为大于等于0的正整数,i表示关节序号,i=1,2,...,N。
其中,力矩τia(nT)的计算包括:设定运动轨迹的起止位置、各关节运行速度的恒定值各关节加速度值为0、机器人采样周期为T,基于所述动力学模型,计算得到对应于每个采样周期的各关节力矩为τia(nT)。
其中,最大速度求解单元包括:
速度增益系数筛选子单元,从所有的关节的所有的周期下的速度增益系数中筛选出最小的速度增益系数作为本次运动轨迹的速度增益系数:
全局最大速度求解子单元,根据速度增益系数筛选子单元选出的速度增益系数λ以及速度增益系数求解单元中设定的运行速度计算得到适用于所有位置点的全局最大速度为并从和电机最大允许速度中选取最小值作为本次运动轨迹的最大速度
或者,最大速度求解单元包括:
速度增益系数筛选子单元,从每个采样周期下的所有的关节的速度增益系数中筛选出最小的速度增益系数作为本次运动轨迹的每个位置点的速度增益系数:
λ(nT)=min{λ2 1(nT),λ2 2(nT),......,λ2 N(nT)}
局部最大速度求解子单元,根据速度增益系数筛选子单元选出的速度增益系数λ(nT)以及速度增益系数求解单元中设定的运行速度计算得到某个位置点的局部最大速度为并从和电机最大允许速度中选取最小值作为本次运动轨迹的某个位置点的最大速度
综上所述,实施本发明的基于动力学模型的机器人最大速度获取方法及系统,具有以下有益效果:本发明基于动力学模型,考虑了各关节力矩的力矩约束,使得求解的最大速度必为机器人最大可承受速度;所求取的最大速度,仅与机器人具体的运动轨迹有关,与先前的工作区域无关,极大提高了机器人的利用效率;进一步的,本发明既可以求取机器人运动时适用于所有位置的最大速度,又可以求取机器人运动时每个位置点可承受的最大速度,其属于高级轨迹规划控制器变最大速度控制的关键参数,可最大化机器人工作效率。
上面结合附图对本发明的实施例进行了描述,但是本发明并不局限于上述的具体实施方式,上述的具体实施方式仅仅是示意性的,而不是限制性的,本领域的普通技术人员在本发明的启示下,在不脱离本发明宗旨和权利要求所保护的范围情况下,还可做出很多形式,这些均属于本发明的保护之内。
Claims (10)
1.一种基于动力学模型的机器人最大速度获取方法,其特征在于,包括以下步骤:
S1、建立机器人的关节力矩与速度以及加速度之间的不显含重力、仅显含与位置相关的惯性力、离心力和科里奥利力的动力学模型:
其中,τa(t)表示N×1的关节力矩向量,B(q(t))为N×N惯量矩阵,为N×N科里奥利力及离心力矩阵,N为机器人关节数,为加速度信息,为速度信息,q(t)为位置信息;
S2、根据设定的位置、速度以及加速度,计算每个采样周期的各关节的力矩τia(nT),且根据各关节力矩的力矩约束范围[τimin,τimax],计算得到各个关节的每个采样周期的速度增益系数λi(nT),T为机器人采样周期;
S3、基于步骤S2中的速度增益系数λi(nT)和电机最大允许速度计算获得机器人最大速度。
2.根据权利要求1所述的基于动力学模型的机器人最大速度获取方法,其特征在于,所述步骤S2中,通过以下公式计算得到各个关节的每个采样周期的速度增益系数λi(nT):
其中,τimin<0且τimax>0;n表示采样序号,n为大于等于0的正整数,i表示关节序号,i=1,2,...,N。
3.根据权利要求1所述的基于动力学模型的机器人最大速度获取方法,其特征在于,步骤S2力矩τia(nT)的计算包括:设定运动轨迹的起止位置、各关节运行速度的恒定值各关节加速度值为0,基于步骤S1中的所述动力学模型,计算得到对应于每个采样周期的各关节力矩为τia(nT)。
4.根据权利要求3所述的基于动力学模型的机器人最大速度获取方法,其特征在于,所述步骤S3包括:
S31、从所有的关节的所有的周期下的速度增益系数中筛选出最小的速度增益系数作为本次运动轨迹的速度增益系数:
S32、根据步骤S31选出的速度增益系数λ以及步骤S2中设定的运行速度计算得到适用于所有位置点的全局最大速度为并从和电机最大允许速度中选取最小值作为本次运动轨迹的最大速度
5.根据权利要求3所述的基于动力学模型的机器人最大速度获取方法,其特征在于,所述步骤S3包括:
S31’、从每个采样周期下的所有的关节的速度增益系数中筛选出最小的速度增益系数作为本次运动轨迹的每个位置点的速度增益系数:
S32’、根据步骤S31’选出的速度增益系数λ(nT)以及步骤S2中设定的运行速度计算得到某个位置点的局部最大速度为并从和电机最大允许速度中选取最小值作为本次运动轨迹的某个位置点的最大速度
6.一种基于动力学模型的机器人最大速度获取系统,其特征在于,包括:
模型建立单元,用于建立机器人的关节力矩与速度以及加速度之间的不显含重力、仅显含与位置相关的惯性力、离心力和科里奥利力的动力学模型:
其中,τa(t)表示N×1的关节力矩向量,B(q(t))为N×N惯量矩阵,为N×N科里奥利力及离心力矩阵,N为机器人关节数,为加速度信息,为速度信息,q(t)为位置信息;
速度增益系数求解单元,根据设定的位置、速度以及加速度,计算每个采样周期的各关节的力矩τia(nT),且根据各关节力矩的力矩约束范围[τimin,τimax],计算得到各个关节的每个采样周期的速度增益系数λi(nT)、T为机器人采样周期;
最大速度求解单元,基于速度增益系数求解单元中得到的速度增益系数λi(nT)和电机最大允许速度计算机器人最大速度。
7.根据权利要求6所述的基于动力学模型的机器人最大速度获取系统,其特征在于,所述速度增益系数求解单元通过以下公式计算得到各个关节的每个采样周期的速度增益系数λi(nT):
其中,τi min<0且τi max>0;n表示采样序号,n为大于等于0的正整数,i表示关节序号,i=1,2,...,N。
8.根据权利要求6所述的基于动力学模型的机器人最大速度获取系统,其特征在于,力矩τia(nT)的计算包括:设定运动轨迹的起止位置、各关节运行速度的恒定值各关节加速度值为0,基于所述动力学模型,计算得到对应于每个采样周期的各关节力矩为τia(nT)。
9.根据权利要求8所述的基于动力学模型的机器人最大速度获取系统,其特征在于,最大速度求解单元包括:
速度增益系数筛选子单元,从所有的关节的所有的周期下的速度增益系数中筛选出最小的速度增益系数作为本次运动轨迹的速度增益系数:
全局最大速度求解子单元,根据速度增益系数筛选子单元选出的速度增益系数λ以及速度增益系数求解单元中设定的运行速度计算得到适用于所有位置点的全局最大速度为并从和电机最大允许速度中选取最小值作为本次运动轨迹的最大速度
10.根据权利要求8所述的基于动力学模型的机器人最大速度获取系统,其特征在于,最大速度求解单元包括:
速度增益系数筛选子单元,从每个采样周期下的所有的关节的速度增益系数中筛选出最小的速度增益系数作为本次运动轨迹的每个位置点的速度增益系数:
λ(nT)=min{λ2 1(nT),λ2 2(nT),......,λ2 N(nT)}
局部最大速度求解子单元,根据速度增益系数筛选子单元选出的速度增益系数λ(nT)以及速度增益系数求解单元中设定的运行速度计算得到某个位置点的局部最大速度为并从和电机最大允许速度中选取最小值作为本次运动轨迹的某个位置点的最大速度
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610460754.4A CN106019942B (zh) | 2016-06-23 | 2016-06-23 | 一种基于动力学模型的机器人最大速度获取方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610460754.4A CN106019942B (zh) | 2016-06-23 | 2016-06-23 | 一种基于动力学模型的机器人最大速度获取方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106019942A CN106019942A (zh) | 2016-10-12 |
CN106019942B true CN106019942B (zh) | 2019-04-16 |
Family
ID=57086514
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610460754.4A Expired - Fee Related CN106019942B (zh) | 2016-06-23 | 2016-06-23 | 一种基于动力学模型的机器人最大速度获取方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106019942B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108890650A (zh) * | 2018-08-30 | 2018-11-27 | 无锡信捷电气股份有限公司 | 基于动力学参数辨识的ptp加速度优化方法及装置 |
CN112223298B (zh) * | 2020-12-08 | 2021-03-05 | 成都卡诺普自动化控制技术有限公司 | 一种确定机器人关节最大加速度和最大速度的方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS62231307A (ja) * | 1986-03-31 | 1987-10-09 | Matsushita Electric Ind Co Ltd | ア−ム制御方法 |
CN105479459A (zh) * | 2015-12-29 | 2016-04-13 | 深圳市汇川技术股份有限公司 | 机器人零力控制方法以及系统 |
-
2016
- 2016-06-23 CN CN201610460754.4A patent/CN106019942B/zh not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS62231307A (ja) * | 1986-03-31 | 1987-10-09 | Matsushita Electric Ind Co Ltd | ア−ム制御方法 |
CN105479459A (zh) * | 2015-12-29 | 2016-04-13 | 深圳市汇川技术股份有限公司 | 机器人零力控制方法以及系统 |
Non-Patent Citations (3)
Title |
---|
Uniform Bounds of the Coriolis/Centripetal Matrix of Serial Robot Manipulators;Juan Ignacio Mulero-Martínez;《IEEE TRANSACTIONS ON ROBOTICS》;20071031;第23卷(第5期);第1083-1089页 |
转动坐标系内运动的分析;张穗萌;《六安师专学报》;19941231;第43-49页 |
转动非惯性系中的惯性力及对河流冲刷两岸的再研究;赵国晴;《邯郸学院学报》;20080930;第18卷(第3期);第75-76页 |
Also Published As
Publication number | Publication date |
---|---|
CN106019942A (zh) | 2016-10-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105479459B (zh) | 机器人零力控制方法以及系统 | |
CN106313044B (zh) | 一种工业机器人前馈力矩补偿方法 | |
CN106533295B (zh) | 永磁同步电机无位置传感器控制方法和装置 | |
CN107425769A (zh) | 一种永磁同步电机调速系统的自抗扰控制方法及系统 | |
CN106452206B (zh) | 一种两轮自平衡机器人的滑模自适应控制器 | |
CN108964545B (zh) | 一种基于命令滤波的同步电机神经网络反步离散控制方法 | |
CN108319148A (zh) | 一种控制力矩陀螺框架伺服系统低转速高精度控制方法 | |
CN108897226A (zh) | 基于干扰观测器的mems陀螺仪预设性能非奇异滑模控制方法 | |
CN110376882A (zh) | 基于有限时间扩张状态观测器的预定性能控制方法 | |
CN108092567A (zh) | 一种永磁同步电动机转速控制系统及方法 | |
CN106019942B (zh) | 一种基于动力学模型的机器人最大速度获取方法及系统 | |
CN110707981A (zh) | 基于新型扩张状态观测器的永磁同步电机速度控制器 | |
CN109167547A (zh) | 基于改进滑模观测器的pmsm无位置传感器控制方法 | |
CN106911282B (zh) | 一种改进模糊控制的永磁电机无速度测速系统 | |
CN105048896B (zh) | 一种无刷直流电机直接转矩自适应模糊控制方法 | |
CN105182801B (zh) | 一种基于扩张状态观测器的Stewart平台主动隔振PD控制方法 | |
CN105048918B (zh) | 一种无刷直流电机自适应模糊控制方法 | |
CN107196570A (zh) | 一种永磁同步电机无传感器控制方法 | |
CN108406765A (zh) | 一种开链式多臂机器人阻抗控制方法 | |
CN106849797A (zh) | 一种双惯性永磁同步电机的电流无源控制方法 | |
CN106078744B (zh) | 一种两轮自平衡机器人滑模自适应控制系统 | |
CN114859708A (zh) | 一种单连杆柔性机械臂跟踪控制方法 | |
Chan et al. | Design and control of small quadcopter system with motor closed loop speed control | |
CN108429501B (zh) | 一种永磁同步电机负载扰动的观测方法 | |
CN108574440A (zh) | 一种基于滑模参考自适应的永磁同步电机状态估计方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20190416 |
|
CF01 | Termination of patent right due to non-payment of annual fee |