一种基于动力学模型的机器人最大速度获取方法及系统的制作方法
【专利摘要】一种基于动力学模型的机器人最大速度获取方法及系统，方法包括：S1、建立机器人的关节力矩与速度以及加速度之间的不显含重力、仅显含与位置相关的惯性力、离心力和科里奥利力的动力学模型：S2、根据设定的位置、速度以及加速度，计算每个采样周期的各关节的力矩τia(nT)，且根据各关节力矩的力矩约束范围[τimin,τimax]，计算得到各个关节的每个采样周期的速度增益系数λi(nT)；S3、基于速度增益系数λi(nT)和电机最大允许速度计算机器人最大速度。本发明考虑了各关节力矩的力矩约束，使得求解的最大速度必为机器人最大可承受速度；所求取的最大速度，仅与机器人具体的运动轨迹有关，与先前的工作区域无关，提高了机器人的利用效率；进一步的，还可求取每个位置点可承受的最大速度。
【专利说明】
-种基于动力学模型的机器人最大速度获取方法及系统
技术领域
[0001] 本发明设及机器人控制领域，尤其设及一种基于动力学模型的机器人最大速度获 取方法及系统。
【背景技术】
[0002] 工业机器人在进行轨迹规划时，为使机器人工作效率最大化，需确定机器人的最 大运行速度限制。目前机器人最大运行速度的限制主要有两个，即机器人关节最大速度限 制和机器人末端最大速度限制。关节最大速度限制主要W最大关节速度为依据，或根据电 机转速力矩曲线确定在满足输出转矩条件下的最大电机速度限制。机器人末端最大速度限 制主要W机器人典型工作区间的最大速度为参考依据。
[0003] 针对关节最大速度限制，由于机器人在不同位姿下，其实际可承受的最大关节速 度不同，甚至会出现关节最大速度限制大于机器人实际可承受的最大关节速度，运势必引 起机器人故障停机，造成机械本体的损坏。
[0004] 针对末端最大速度，同样存在机器人末端最大速度与机器人位姿相关的问题。虽 然可W通过雅克比矩阵建立机器人关节速度和机器人末端速度的映射关系，但如果单纯W 最大关节速度计算最大末端速度，而不考虑机器人各关节实际输出力矩的限制，机器人可 能因关节力矩超限而无法承受该最大速度。因此，在实际使用过程中，机器人最大末端速度 主要W典型工作区域的最大速度为参考。为使机器人能在较大工作空间中正常运行，其典 型工作区域需尽可能大。但工作区域越大，对应的可满足整个工作区域正常运行的最大速 度限制也就越小，运将严重降低机器人的工作效率。
【发明内容】
[0005] 本发明要解决的技术问题在于，针对现有技术的上述缺陷，提供一种基于动力学 模型的机器人最大速度获取方法及系统。
[0006] 本发明解决其技术问题所采用的技术方案是:构造一种基于动力学模型的机器人 最大速度获取方法，包括W下步骤：
[0007] S1、建立机器人的关节力矩与速度W及加速度之间的不显含重力、仅显含与位置 相关的惯性力、离屯、力和科单奥利力的动力学横巧：
[000引
CA)
[0009] 其中，Ta(t)表示NXl的关节力矩向量，B(q(t))为NXN惯量矩阵，C(q(t)，^-))为N XN科里奥利力及离屯、力矩阵，N为机器人关节数，;；始)为加速度信息，为速度信息，q(t) 为位置信息；
[0010] S2、根据设定的位置、速度W及加速度，计算每个采样周期的各关节的力矩Tia (nT)，且根据各关节力矩的力矩约束范围[Timin，Timax]，计算得到各个关节的每个采样周期 的速度增益系数、(nT);
[0011] S3、基于步骤S2中的速度增益系数、(nT)和电机最大允许速度^。，。,。1.计算获得机器 人最大速度。
[0012] 在本发明所述的基于动力学模型的机器人最大速度获取方法中，所述步骤S2中， 通过W下公式计算得到各个关节的每个采样周期的速度增益系数、(nT):
[0013]
B；
[0014] 其中，Timin<0且Timax>0;n表示采样序号，n为大于等于0的正整数，i表示关节序 号，i 二 1,2,...,No
[0015] 在本发明所述的基于动力学模型的机器人最大速度获取方法中，步骤S2力矩Tia (nT)的计算包括:设定运动轨迹的起止位置、各关节运行速度的恒定值、各关节加速度值 为0、机器人采样周期为T，基于步骤Sl中的所述动力学模型，计算得到对应于每个采样周期 的各关节力矩为Tia(nT)。
[0016] 在本发明所述的基于动力学模型的机器人最大速度获取方法中，所述步骤S3包 括：
[0017] S31、从所有的关节的所有的周期下的速度增益系数中筛选出最小的速度增益系 数作为本次运动轨迹的速度增益系数：
[001 引
[0019] S32、根据步骤S31选出的速度增益系数AW及步骤S2中设定的运行速度^计算得 到适用于所有位置点的全局最大速度为^ ，并从义^和电机最大允许速度中选取最 小值作为本次运动轨迹的最大速运
[0020] 在本发明所述的基于动力学模型的机器人最大速度获取方法中，所述步骤S3包 括：
[0021] S31'、从每个采样周期下的所有的关节的速度增益系数中筛选出最小的速度增益 系数作为本次运动轨迹的每个位置点的速度增益系数：
[0022] A(nT) =min{A^i(nT) ,A^2(nT),......,A^N(nT)}
[0023] S32'、根据步骤S31'选出的速度增益系数MnT) W及步骤S2中设定的运行速度4 计算得到某个位置点的局部最大速度为并从地和电机最大允许速度中选取 最小值作为本次运动轨迹的某个位置点的最大速度
[0024] 本发明还公开了一种基于动力学模型的机器人最大速度获取系统，包括：
[0025] 模型建立单元，用于建立机器人的关节力矩与速度W及加速度之间的不显含重 力、仅显含与位置相关的惯性力、离屯、力和科里奥利力的动力学模型：
[0026]
(A)
[0027] 其中，Ta(t)表示NXl的关节力矩向量，B(q(t))为NX州贯量矩阵，C(q(t)，;肋)为N XN科里奥利力及离屯、力矩阵，N为机器人关节数，;为加速度信息(f)为速度信息，q(t) 为位置信息；
[0028] 速度增益系数求解单元，根据设定的位置、速度W及加速度，计算每个采样周期的 各关节的力矩Tia(nT)，且根据各关节力矩的力矩约束范围[Timin，TimaxL计算得到各个关节 的每个采样周期的速度增益系数、(nT);
[0029] 最大速度求解单元，基于速度增益系数求解单元中得到的速度增益系数、(nT)和 电机最大允许速度^ ,计算机器人最大速度。 3 W位化广
[0030] 在本发明所述的基于动力学模型的机器人最大速度获取系统中，所述速度增益系 数求解单元通过W下公式计算得到各个关节的每个采样周期的速度增益系数、(nT):
[0031]
(B)
[0032] 其中，Timin<0且Timax>0 ;n表示采样序号，n为大于等于0的正整数，i表示关节序 号，i = l，2,. . .，N。
[0033] 在本发明所述的基于动力学模型的机器人最大速度获取系统中，力矩Tia(nT)的计 算包括:设定运动轨迹的起止位置、各关节运行速度的恒定值^、各关节加速度值为0、机器 人采样周期为T，基于所述动力学模型，计算得到对应于每个采样周期的各关节力矩为Tia (nT)。
[0034] 在本发明所述的基于动力学模型的机器人最大速度获取系统中，最大速度求解单 元包括：
[0035] 速度增益系数筛选子单元，从所有的关节的所有的周期下的速度增益系数中筛选 出最小的速度增益系数作为本次运动轨迹的速度增益系数：
[0036]
[0037] 全局最大速度求解子单元，根据速度增益系数筛选子单元选出的速度增益系数入 W及速度增益系数求解单元中设定的运行速度计算得到适用于所有位置点的全局最大
速度为;I ，并从1 和电机最大允许速度中选取最小值作为本次运动轨迹的最大速 ^ ? ^'9'IiiaX
[0038] 在本发明所述的基于动力学模型的机器人最大速度获取系统中，最大速度求解单 元包括：
[0039] 速度增益系数筛选子单元，从每个采样周期下的所有的关节的速度增益系数中筛 选出最小的速度增益系数作为本次运动轨迹的每个位置点的速度增益系数：
[0040] A(nT) =min{A\(nT) ,A^2(nT),......,入\(。了）}
[0041] 局部最大速度求解子单元，根据速度增益系数筛选子单元选出的速度增益系数入 (nT) W及速度增益系数求解单元中设定的运行速度计算得到某个位置点的局部最大速 度为义(.6巧9。，并从2知巧9。和电机最大允许速度中选取最小值作为本次运动轨迹的 某个位置点的最大速度<^"。、(/^7')
[0042] 实施本发明的基于动力学模型的机器人最大速度获取方法及系统，具有W下有益 效果:本发明基于动力学模型，考虑了各关节力矩的力矩约束，使得求解的最大速度必为机 器人最大可承受速度;所求取的最大速度，仅与机器人具体的运动轨迹有关，与先前的工作 区域无关，极大提高了机器人的利用效率;进一步的，本发明既可W求取机器人运动时适用 于所有位置的最大速度，又可W求取机器人运动时每个位置点可承受的最大速度，其属于 高级轨迹规划控制器变最大速度控制的关键参数，可最大化机器人工作效率。
【附图说明】
[0043] 下面将结合附图及实施例对本发明作进一步说明，附图中：
[0044] 图1是本发明的基于动力学模型的机器人最大速度获取方法的流程图；
[0045] 图2为初始速度下机器人各关节力矩图；
[0046] 图3为初始速度下各个位置点最大的A允许值示意图；
[0047] 图4为最大速度下机器人各关节力矩图。
【具体实施方式】
[004引为了对本发明的技术特征、目的和效果有更加清楚的理解，现对照附图详细说明 本发明的【具体实施方式】。
[0049] 参考图1，是本发明的基于动力学模型的机器人最大速度获取方法的流程图。
[0050] 本发明的基于动力学模型的机器人最大速度获取方法包括W下步骤：
[0051] S1、建立机器人的关节力矩与速度W及加速度之间的不显含重力、仅显含与位置 相关的惯性力、离屯、力和科里奥利力的动力学模型：
[0化2]
(A)
[0053] 其中，Ta(t)表示NXl的关节力矩向量，B(q(t))为NXN惯量矩阵，c(g(f)，;的）为N XN科里奥利力及离屯、力矩阵，N为机器人关节数，；；(巧为加速度信息，^狂)为速度信息，q(t) 为位置信息；
[0054] S2、根据设定的位置、速度W及加速度，计算每个采样周期的各关节的力矩Tia (nT)，且根据各关节力矩的力矩约束范围[Timin，Timax]，计算得到各个关节的每个采样周期 的速度增益系数、(nT);
[0化日]S3、基于步骤S2中的速度增益系数、(nT)和电机最大允许速度 计算机器人最 'ImoUxr 大速度。
[0056]下面详细介绍各个步骤。
[0化7] 关于步骤Sl:
[005引众所周知，具有标准形式的机器人动力学模型的表达式如下：
[0059]
(1)
[0060] 其中，嗦示NXl的关节力矩向量，B(q(t))为NXN惯量矩阵，C(q(t)，;树）为NXN 科里奥利力及离屯、力矩阵，G(q(t))为NXl的重力向量，N为机器人关节数，；为加速度信 息，为速度信息，q (t)为位置信息；
[0061] 步骤Sl的动力学模型是对公式（1)的机器人标准动力学模型进行简单的数学变 换，使力矩Ta(t)仅与惯性力、科里奥利力、速度、加速度有关，而与重力无关，改写过程为：
[0062]
[0063] 关于步骤S2:
[0064] 步骤S2中通过W下公式计算得到各个关节的每个采样周期的速度增益系数、 (nT)：
[0065]
CB)
[0066] 其中，Timin<0且Timax>0;n表示采样序号，n为大于等于0的正整数，i表示关节序 号，i二1,2,...,N。
[0067] 其中，公式(B)的推导过程如下：
[0068] 对公式(A)的动力学模型进行数学变换，假设S = U,则：
[0071] 将上面的公式(BI)和公式(B2)代入公式(A)，则可W推导得到公式(C):
[0069]
[0070] 腿）
[0072]
(C)
[0073] 目P，从公式(C)可W得到速度增益系数A、力矩Ta(t)、力矩Ta(S)之间的关系如公式 (D)：
[0074]
CD)
[0075] 基于公式化），我们把力矩Tia(nT)作为公式(D)中的Ta(S),各力矩约束范围作为公 式(D)中的Ta(t)，于是可W计算得到各个关节的每个采样周期的速度增益系数。由于公式 (D)中的A2肯定大于等于0,又TiminCO且Timax>0,所W，在Tia(nT) >〇Tia(nT)时，则选择Timax 代入公式(D)，在Tia(nT)<0时，则选择Timin代入公式(D)，于是可W得到上述的(B)。
[0076] 从公式(A)可知，各关节力矩Ta的计算依赖于速度、加速度W及位置，所W-个具 体实施例中，步骤S2力矩Tia(nT)的计算具体为:设定运动轨迹的起止位置、各关节运行速度 的恒定值^<，、各关节加速度值为〇、机器人采样周期为1'，基于步骤51中的所述动力学模型的 公式(A)，计算得到对应于每个采样周期的各关节力矩为Tia(nT)。
[0077] 关于步骤S3:
[0078] 步骤S3求取的最大速度有两种，一种是适用于所有位置的全局最大速度，一种是 针对每个位置的局部最大速度。
[0079] 当求取全局最大速度时，所述步骤S3包括：
[0080] S31、从所有的关节的所有的周期下的速度增益系数中筛选出最小的速度增益系 数作为本次运动轨迹的速度增益系数：
[0081]
[0082] S32、根据步骤S31选出的速度增益系数AW及步骤S2中设定的运行速度计算得 到适用于所有位置点的全局最大速度为^ (7a ,并从^ 和电机最大允许速度?中选取最 小值作为本次运动轨迹的最大速度
[0083] 当求取局部最大速度时，所述步骤S3包括：
[0084] S31'、从每个采样周期下的所有的关节的速度增益系数中筛选出最小的速度增益 系数作为本次运动轨迹的每个位置点的速度增益系数：
[00化]A(nT) =min{A(nT),入22(nT),......,入\(。了）}
[00化]S32'、根据步骤S31'选出的速度增益系数MnT) W及步骤S2中设定的运行速度 计算得到某个位置点的局部最大速度为抓町J。，并从如。和电机最大允许速度I,。,。冲选取 最小值作为本次运动轨迹的某个位置点的最大速度;^、(nr):
[0087]下面结合具体的实施案例对本发明作进一步说明。
[008引现W某SCARA机器人第一、二关节为最大速度求解实施对象，首先建立动力学模型 如下：
[0089]
[0090] 其中，/?为第1，2连杆绕质屯、坐标系巧由的转动惯量，听，：W/;为第1，2连杆质 量(含电机等转配部件），曰1，曰2为第1，2连杆长度，h，b为第1，2连杆质屯、距离连杆起始处的 长度，qi，q2,違，4，i，;为第1，2连杆旋转的角度，速度及加速度，31，。1为第1个连杆 位置的正余弦运算，Tl，T2为第1，2连杆的力矩。
[0091] 按照上述步骤S2,设定初始第一二关节起止位置为[-120,120]°，设定第一二关节 速度4均为600°/s,设置加速度为0,可得在该组轨迹参数下，各关节运动的力矩Tia(nT)及 速度曲线分别如图2所示。根据上述步骤S2设置第一二关节力矩限制均为[-63.5侃1， 63.5Nm]，可求得针对每一个位置点的可取的M直并绘制成曲线如图3所示，该图中最小的被 允许的M直为1.7874,为说明本发明的有效性，此处暂不考虑电机最大转速，则最大速度为 1.7874*600Vs = 1072.4°/s，计算在上述最大速度运动情况下各关节力矩曲线如图4所示。
[0092] 通过图4可W看出，当机器人W最大速度1072.4°/s运行时，第一关节电机实际输 出转矩在某些位置可达最大关节电机输出扭矩，运说明此时机器人运行的速度确实是机器 人最大可承受的速度;但在任何一个位置点，各关节实际输出扭矩均小于或等于最大关节 扭矩限制值，运说明了机器人此速度下运行是切实可行的。W上两个方面证明了基于本发 明所求解的最大速度在保证机器人正常运行的前提下，切实提高了机器人的利用效率。
[0093] 相应的，本发明还公开了一种基于动力学模型的机器人最大速度获取系统，包括：
[0094] 模型建立单元，用于建立机器人的关节力矩与速度W及加速度之间的不显含重 力、仅显含与位置相关的惯性力、离屯、力和科里奥利力的动力学模型：
[0095]
? (A)
[0096] 其中，Ta(t)表示N X 1的关节力矩向量，B(q(t))为N X N惯量矩阵，C(如)，* (f))为N XN科里奥利力及离屯、力矩阵，N为机器人关节数，为加速度信息，^幻为速度信息，q(t) 为位置信息；
[0097] 速度增益系数求解单元，根据设定的位置、速度W及加速度，计算每个采样周期的 各关节的力矩Tia(nT)，且根据各关节力矩的力矩约束范围[Timin，TimaxL计算得到各个关节 的每个采样周期的速度增益系数、(nT);
[0098] 最大速度求解单元，基于速度增益系数求解单元中得到的速度增益系数、(nT)和 电机最大允许速度^ ,计算机器人最大速度。 i mutof
[0099] 其中，所述速度增益系数求解单元通过W下公式计算得到各个关节的每个采样周 期的速度增益系数、(nT):
[0100]
化）
[0101] 其中，Timin<0且Timax>0 ;n表示采样序号，n为大于等于0的正整数，i表示关节序 号，i = l，2,. . .，N。
[0102] 其中，力矩Tia(nT)的计算包括:设定运动轨迹的起止位置、各关节运行速度的恒定 值i .、各关节加速度值为0、机器人采样周期为T，基于所述动力学模型，计算得到对应于每 个采样周期的各关节力矩为Tia(nT)。
[0103] 其中，最大速度求解单元包括：
[0104] 速度增益系数筛选子单元，从所有的关节的所有的周期下的速度增益系数中筛选 出最小的速度增益系数作为本次运动轨迹的速度增益系数：
[0105]
[0106] 全局最大速度求解子单元，根据速度增益系数筛选子单元选出的速度增益系数入 W及速度增益系数求解单元中设定的运行速度计算得到适用于所有位置点的全局最大 速度为义4，并从/1J。和电机最大允许速度;中选取最小值作为本次运动轨迹的最大速 謹；：
[0107] 或者，最大速度求解单元包括：
[0108] 速度增益系数筛选子单元，从每个采样周期下的所有的关节的速度增益系数中筛 选出最小的速度增益系数作为本次运动轨迹的每个位置点的速度增益系数：
[0109] A(nT) =min{A^i(nT) ,A^2(nT),......,A^N(nT)}
[0110] 局部最大速度求解子单元，根据速度增益系数筛选子单元选出的速度增益系数入 (nT) W及速度增益系数求解单元中设定的运行速度计算得到某个位置点的局部最大速 度为/1(?乃，并从ibr) g'。和电机最大允许速度中选取最小值作为本次运动轨迹的 某个位置点的最大速度
[0111] 综上所述，实施本发明的基于动力学模型的机器人最大速度获取方法及系统，具 有W下有益效果:本发明基于动力学模型，考虑了各关节力矩的力矩约束，使得求解的最大 速度必为机器人最大可承受速度;所求取的最大速度，仅与机器人具体的运动轨迹有关，与 先前的工作区域无关，极大提高了机器人的利用效率;进一步的，本发明既可W求取机器人 运动时适用于所有位置的最大速度，又可W求取机器人运动时每个位置点可承受的最大速 度，其属于高级轨迹规划控制器变最大速度控制的关键参数，可最大化机器人工作效率。
[0112]上面结合附图对本发明的实施例进行了描述，但是本发明并不局限于上述的具体 实施方式，上述的【具体实施方式】仅仅是示意性的，而不是限制性的，本领域的普通技术人员 在本发明的启示下，在不脱离本发明宗旨和权利要求所保护的范围情况下，还可做出很多 形式，运些均属于本发明的保护之内。
【主权项】
1. 一种基于动力学模型的机器人最大速度获取方法，其特征在于，包括以下步骤： 51、 建立机器人的关节力矩与速度以及加速度之间的不显含重力、仅显含与位置相关 的惯性力、离心力和科里奥利力的动力学模型：其中，Ta(t)表示NXl的关节力矩向量，B(q(t))为NXN惯量矩阵，C(Wr)，)为NXN科 里奥利力及离心力矩阵，N为机器人关节数，为加速度信息为速度信息，q(t)为位 置信息； 52、 根据设定的位置、速度以及加速度，计算每个采样周期的各关节的力矩ila(nT)，且 根据各关节力矩的力矩约束范围[τ_，T imax]，计算得到各个关节的每个采样周期的速度增 益系数M(nT); 53、 基于步骤S2中的速度增益系数A1(I1T)和电机最大允许速度计算获得机器人最 大速度。2. 根据权利要求1所述的基于动力学模型的机器人最大速度获取方法，其特征在于，所 述步骤S2中，通过以下公式计算得到各个关节的每个采样周期的速度增益系数M(nT):其中，11"1"<0且11_>0 ;n表示采样序号，η为大于等于O的正整数，i表示关节序号，i = 1，2,···，N〇3. 根据权利要求1所述的基于动力学模型的机器人最大速度获取方法，其特征在于，步 骤S2力矩Tla(nT)的计算包括:设定运动轨迹的起止位置、各关节运行速度的恒定值各 关节加速度值为〇、机器人采样周期为T，基于步骤Sl中的所述动力学模型，计算得到对应于 每个采样周期的各关节力矩为ila(nT)。4. 根据权利要求3所述的基于动力学模型的机器人最大速度获取方法，其特征在于，所 述步骤S3包括： 531、 从所有的关节的所有的周期下的速度增益系数中筛选出最小的速度增益系数作 为本次运动轨迹的谏度增益系数：532、 根据步骤S31选出的速度增益系数λ以及步骤S2中设定的运行速度^计算得到适用 于所有位置点的全局最大速度为;I ^，并从Λ ^和电机最大允许速度中选取最小值作 为本次运动轨迹的最大速度a,lu = HiinU(^gwwii)05. 根据权利要求3所述的基于动力学模型的机器人最大速度获取方法，其特征在于，所 述步骤S3包括： S31'、从每个采样周期下的所有的关节的速度增益系数中筛选出最小的速度增益系数 作为太汝沄动轨协的毎个份詈?的谏庶增益系教，S32'、根据步骤S31'选出的速度增益系数λ(ηΤ)以及步骤S2中设定的运行速度^计算得 到某个位置点的局部最大速度为Κ/7Π ^，并从办^和电机最大允许速度中选取最小 值作为本次运动轨迹的某个位置点的最大速度<^>门^>7) = ininUQn 。6. -种基于动力学模型的机器人最大速度获取系统，其特征在于，包括： 模型建立单元，用于建立机器人的关节力矩与速度以及加速度之间的不显含重力、仅 显含与位置相关的惯性力、离心力和科里奥利力的动力学模型：其中，Ta⑴表示NXl的关节力矩向量，B(q(t))为NXN惯量矩阵，"％)，^))为NXN科 里奥利力及离心力矩阵，N为机器人关节数，为加速度信息，为速度信息，q(t)为位 置信息； 速度增益系数求解单元，根据设定的位置、速度以及加速度，计算每个采样周期的各关 节的力矩ila(nT)，且根据各关节力矩的力矩约束范围[Timin，Timax]，计算得到各个关节的每 个采样周期的速度增益系数M(nT); 最大速度求解单元，基于速度增益系数求解单元中得到的速度增益系数M(nT)和电机 最大允许速度^ 计算机器人最大速度。 ? motor7. 根据权利要求6所述的基于动力学模型的机器人最大速度获取系统，其特征在于，所 述速度增益系数求解单元通过以下公式计算得到各个关节的每个采样周期的速度增益系 数 Μ(ηΤ):其中，11"1"<0且11_>0 ;η表示采样序号，η为大于等于O的正整数，i表示关节序号，i = 1，2,···，N〇8. 根据权利要求6所述的基于动力学模型的机器人最大速度获取系统，其特征在于，力 矩ila(nT)的计算包括:设定运动轨迹的起止位置、各关节运行速度的恒定值4、各关节加 速度值为〇、机器人采样周期为T，基于所述动力学模型，计算得到对应于每个采样周期的各 关节力矩为Tia(nT)。9. 根据权利要求8所述的基于动力学模型的机器人最大速度获取系统，其特征在于，最 大速度求解单元包括： 速度增益系数筛选子单元，从所有的关节的所有的周期下的速度增益系数中筛选出最 小的速度增益系数作为本次运动轨迹的速度增益系数： A=HiinI^21(O) ,A21(T)，......,λ2ι(ηΤ),全局最大速度求解子单元，根据速度增益系数筛选子单元选出的速度增益系数λ以及 速度增益系数求解单元中设定的运行速度4计算得到适用于所有位置点的全局最大速度 为2 ^，并从2 ^和电机最大允许速度.中选取最小值作为本次运动轨迹的最大速度10.根据权利要求8所述的基于动力学模型的机器人最大速度获取系统，其特征在于， 最大速度求解单元包括： 速度增益系数筛选子单元，从每个采样周期下的所有的关节的速度增益系数中筛选出 最小的速度增益系数作为本次运动轨迹的每个位置点的速度增益系数：局部最大速度求解子单元，根据速度增益系数筛选子单元选出的速度增益系数λ(ηΤ) 以及速度增益系数求解单元中设定的运行速度^计算得到某个位置点的局部最大速度为 Γ) % ,并从Kaf) %和电机最大允许速度.中选取最小值作为本次运动轨迹的某个 位置点的最大速
【文档编号】G05B13/04GK106019942SQ201610460754
【公开日】2016年10月12日
【申请日】2016年6月23日
【发明人】杨磊, 屈云飞
【申请人】深圳市汇川技术股份有限公司