主权项 |
1.一种基于动态响应谱的关节含间隙机器人轨迹规划方法,其特征在于该方法的步骤如下:(1)为机器人主动关节选择运动多项式函数:在机器人关节空间中进行轨迹规划,设笛卡尔空间中有P+1个路径点,通过反向运动学求解,把这P+1个路径点映射到机器人关节空间,设机器人有K个主动关节,每个主动关节的运动轨迹用P段多项式函数描述:q<sub>k,p</sub>(t)=A<sub>k,p,H</sub>t<sup>H</sup>+A<sub>k,p,H-1</sub>t<sup>H-1</sup>+…+A<sub>k,p,h</sub>t<sup>h</sup>+…+A<sub>k,p,1</sub>t+A<sub>k,p,0</sub> (式1)t∈[0,T<sub>p</sub>],h=0,1,…,H,p=1,2,…,P,k=1,2,…,K其中q<sub>k,p</sub>(t)表示第k个主动关节的第p段运动轨迹,A<sub>k,p,h</sub>为第k个主动关节第p段轨迹的h次项系数,T<sub>p</sub>为第p段轨迹的时间长度,t表示时间,H为运动多项式阶次,对(式1)求导获得关节速度的函数,再次求导将获得关节加速度的函数;(2)计算运动多项式函数的待定系数:取运动多项式阶次H的初值为5,根据主动关节的各段运动轨迹上路径起点与终点的位置、速度与加速度的约束条件,求解五次运动多项式函数含有的6个待定系数;(3)求解含间隙关节的关节反力:设机器人有C个含间隙关节,则每个含间隙关节中驱动构件受力<img file="FSB00000390117200011.GIF" wi="38" he="49" />也是P段多项式函数:<maths num="0001"><![CDATA[<math><mrow><mover><msub><mi>F</mi><mrow><mi>i</mi><mo>,</mo><mi>p</mi></mrow></msub><mo>‾</mo></mover><mo>=</mo><mo>[</mo><msub><mi>W</mi><mrow><mi>i</mi><mo>,</mo><mi>p</mi><mo>,</mo><mi>U</mi></mrow></msub><mo>]</mo><msup><mi>t</mi><mi>U</mi></msup><mo>+</mo><mo>[</mo><msub><mi>W</mi><mrow><mi>i</mi><mo>,</mo><mi>p</mi><mo>,</mo><mi>U</mi><mo>-</mo><mn>1</mn></mrow></msub><mo>]</mo><msup><mi>t</mi><mrow><mi>U</mi><mo>-</mo><mn>1</mn></mrow></msup><mo>+</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>+</mo><mo>[</mo><msub><mi>W</mi><mrow><mi>i</mi><mo>,</mo><mi>p</mi><mo>,</mo><mi>U</mi></mrow></msub><mo>]</mo><msup><mi>t</mi><mi>u</mi></msup><mo>+</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>+</mo><mo>[</mo><msub><mi>W</mi><mrow><mi>i</mi><mo>,</mo><mi>p</mi><mo>,</mo><mn>1</mn></mrow></msub><mo>]</mo><mi>t</mi><mo>+</mo><mo>[</mo><msub><mi>W</mi><mrow><mi>i</mi><mo>,</mo><mi>p</mi><mo>,</mo><mn>0</mn></mrow></msub><mo>]</mo></mrow></math>]]></maths>u=0,1,…,U,i=1,2,…,C其中<img file="FSB00000390117200013.GIF" wi="70" he="66" />表示第i个含间隙关节中驱动构件在第p段运动轨迹中所受的力,多项式函数的阶次U取决于各主动关节运动轨迹函数的阶次;[W<sub>i,p,u</sub>]为第i个含间隙关节的关节反力在第p段运动轨迹上的多项式函数的u次项系数,这是一个3行1列的矩阵,每行元素是运动轨迹q<sub>k,p</sub>(t)的系数A<sub>k,p,h</sub>的函数;(4)根据含间隙关节的关节反力构造动态响应谱:关节反力的模是T<sub>p</sub>和t的函数,其中t∈[0,T<sub>p</sub>],动态响应谱是关节反力的模随时间和轨迹时间长度改变而发生变化的图谱;(5)从动态响应谱中选择合适的轨迹时间变量,使得关节连接的两构件在运动过程中始终保持接触:轨迹规划中轨迹时间变量T<sub>p</sub>的取值依据为,T<sub>p</sub>的取值必须满足对任意t∈[0,T<sub>p</sub>],各关节反力的模大于0;(6)若动态响应谱中没有符合要求的轨迹时间变量时,则增加运动多项式函数的阶次H,返回步骤(1);否则,若找到了合适的轨迹时间变量,则轨迹规划完成。 |