CN107139171A - 一种基于力矩控制的工业机器人避障轨迹规划方法 - Google Patents
一种基于力矩控制的工业机器人避障轨迹规划方法 Download PDFInfo
- Publication number
- CN107139171A CN107139171A CN201710321576.1A CN201710321576A CN107139171A CN 107139171 A CN107139171 A CN 107139171A CN 201710321576 A CN201710321576 A CN 201710321576A CN 107139171 A CN107139171 A CN 107139171A
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- joint
- mfrac
- msubsup
- 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.)
- Granted
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/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
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
- Secondary Cells (AREA)
Abstract
一种基于力矩控制的工业机器人高速高精度避障轨迹规划方法,通过辨识各关节运动学以及惯性参数建立机器人动力学模型;通过逆运动学求解得到运动到终点姿态时各关节角的位移;以关节角位移作为运动路程,采用一种正弦加加速度规划方法进行各关节的速度加速度规划,将速度和加速度代入动力学模型即可求解运动路径中的控制力矩;采用一种检测关节投影干涉情况然后判断关键点距离的方法进行碰撞检测;检测到碰撞可能发生,然后对危险关节施加一种阻抗加速度降低关节运动速度从而实现避障。本发明提供了一种控制精度较高、有效实现避障、安全性较高的基于力矩控制的工业机器人避障轨迹规划方法。
Description
技术领域
本发明涉及一种工业机器人轨迹规划方法,尤其是一种工业机器人避障轨迹规划方法。
背景技术
近十几年工业机器人的制造和控制技术发展迅速,已经广泛地应用于汽车制造业并能达到很高的控制精度。随着我国劳动力成本增加,在“机器换人”和产业升级的要求下各行业的自动化生产水平亟需提高。应用工业机器人能够避免重复繁琐的人工劳动、实现高稳定、高精度生产,从而使工作效率得到很大提升。对单个机器人的路径、轨迹规划大多能通过人工示教完成,所以已经有越来越多的工厂使用可编程的工业机器人代替生产线上的人工。但是对于一类需要多机器人互相协调配合才能完成的任务,如何让机器人能够避免可能出现的干涉和碰撞同时能快速准确地完成任务,这便对机器人关节运动控制以及避障路径规划提出了更高要求。
发明内容
为了克服已有工业机器人轨迹规划方法的控制精度较低、无法有效避障、安全性较低的不足,本发明提供了一种控制精度较高、有效实现避障、安全性较高的基于力矩控制的工业机器人避障轨迹规划方法。
本发明解决其技术问题所采用的技术方案是:
一种基于力矩控制的工业机器人避障轨迹规划方法,首先,通过辨识各关节运动学以及惯性参数建立机器人动力学模型;然后,通过逆运动学求解得到运动到终点姿态时各关节角的位移;最后,以关节角位移作为运动路程,采用一种正弦加加速度规划方法进行各关节的速度加速度规划,将速度和加速度代入动力学模型即可求解运动路径中的控制力矩;
对于运行过程中可能发的碰撞,采用一种检测关节投影干涉情况然后判断关键点距离的方法进行碰撞预测:将机器人关节向速度向量的法平面投影,若关节投影发生干涉则对关节轴线上各关键点最短距离进行判断,若小于运行时的安全距离则认为存在碰撞的风险;预测到碰撞可能发生,然后对危险关节施加一种阻抗加速度降低关节运动速度从而实现避障。
进一步,所述规划方法包括以下步骤:
步骤1:工业机器人的动力学参数辨识
采用对机器人整体进行试验的整体辨识法对机器人的动力学参数进行辨识。为了使机器人能实现任意轨迹规划,采用周期性轨迹,每个关节的激励轨迹是正弦和余弦函数的代数和,即有限的傅立叶级数函数,则机器人每个关节的关节位置q规划如下:
其中q表示关节转角,ai、bi表示轨迹的常系数,ωf为轨迹的基频,iωf表示第i阶的频率,t=kTs表示采样时刻,k表示采样个数,Ts表示采样周期;
以有限的傅立叶级数函数为机器人待辨识关节的辨识激励轨迹,机器人沿预设轨迹运动过程中,通过测电流法采集关节的驱动力矩;通过安装在电机上的编码器采集关节转角,对转角微分得到动态参数中的角速度和角加速度以最小二乘法作为辨识算法可以求解出惯性参数的值:
从而求得精确地动力学模型:其中τ为机器人的驱动力矩;向量D(q)称为机械臂的质量矩阵;为科氏力及离心力项;G(q)为重力项;
步骤2:工业机器人运动学逆解
采用解析解法求解机器人从初始位置到末端位置各关节运动角位移,对于逆运动学求解出现多解和奇异解的问题,除了通过设定各个关节的旋转范围限制来去除无效解和避免奇异解的方法以外,还根据运动能量最小原则选择消耗能量最小的逆解值作为关节的执行量,计算方法如下:计算与前一个关节差的平方和,选择计算结果最小的一组关节位置作为下一个关节执行的位置,逆解选择的表达式如下:
步骤3:正弦加加速度关节轨迹规划
采用正弦加加速度规划方法能够对各关节轨迹进行高速、平滑的规划,完成从起点到终点的姿态规划。
为了能够实现运动速度以及加速度控制的能力,对于机器人末端操作器的速度,加速度的边界进行限制,有如下三点:
1)运动角位移:D;
2)运动学上边界:最大角速度ωmax,最大角加速度αmax,最大角加加速度Jmax。
3)运动学下边界:
将加加速度设定为正弦函数曲线:
在运动轨迹的限制条件下,运动距离具有两个临界点,其分别为Dmin和Dmin2,在维持加加速度不变的情况下,最大速度和最大加速度都能够达到,运动位移有一个临界最小值,称为Dmin:
其中dmin为初速为零时加速到ωmax时的运动距离daccinc表示加速到最大速度时的运动距离;daccdec表示加ω速度减小到最小值时运动的距离;如果最大加速度未能够达到但是恰好达到了最大速度,运动位移有另一个临界值最小值,被称为Dmin2:
其中dt′为重新计算后的加速运动时间,然后根据运动边界值的不同计算出不同阶段的运动时间,通过对正弦曲线的加加速度积分得到加速度、速度以及位移的运动轨迹;
步骤4:碰撞预测
对于两个机器人同时作业,按照关节几何形状,采用半球端面圆柱体包络两个关节从而得到标准化后的关节边界,两球面端点连线为关节轴线,长度为li,i=1,2;圆柱体半径为ri,在各轴线按等间距取个点作为计算关节距离的关键点记为根据关节轴线上所取关键点可得两关节碰撞时的临界距离:
根据dhit设定碰撞预测的极限距离dlim=k1*dhit以及安全距离dsafe=k2*dhit,k1,k2为安全系数;
根据关节角位移以及瞬时角速度可由正运动学求解得各关键点的笛卡尔坐标以及关节末端速度向量VF,将投影到VF向量的法平面得到关键点的投影点判断各投影点之间的最小距离若:
则说明两个关节在速度向量法平面的投影发生干涉,则进一步判断各关节关键点之间最短距离,若有:
d=min{||P11-P21||,||P11-P22||,||P11-P23||...||p11-P24||}<dsafe
则判定为有可能碰撞的危险状态,否则认为是安全运行;
步骤5:阻抗控制避障规划
如果步骤4中的关键点之间最短距离d<dsafe,则在后续的运行过程中可能会发生碰撞,采用一种通过判断d与dsafe、dlim之间大小关系确定阻抗加速度αv的方法使各关节减速从而避免障碍:
直到d>dsafe则更新角速度为当前运动角速度ωi以及路径距离Di,然后继续按步骤3的正弦加加速度方法进行速度和加速度规划。
再进一步,所述步骤3中,如果任务要求的执行距离D大于最大加速度和最大速度同时能够达到的最小距离Dmin,D≥Dmin2,那么将根据如下公式:
Taccinc表示加速到最大速度时的运动时间;Taccdec表示加ω速度减小到最小值时运动的时间;Tacc表示在加速度增加到最大值恒定阶段时加速过程中运动的时间,Tret表示在负加速度增加到最大值恒定阶段时减速过程中运动的时间,Tvel表示恒速运动的时间。
所述步骤3中,如果任务要求的运动距离D小于满足最大加速度的最小距离Dmin,但是大于能够达到最大速度距离,D≥Dmin2;这时运动达到的最大加速度以及加速运动时间需要重新计算得:
Taccinc=Taccdec=dt′,Tretinc=Tretdec=dt,Tacc=0,
所述步骤3中,如果任务给定的运动距离D不足以使得速度和加速度都达到给定的速度和加速度,D≤Dmin2,那么采取先匀速后减速的运动策略:
当D>αmaxdt,
当D<αmaxdt时减速运动时间和最大加速度需要根据距离重新计算:
利用正弦加加速度轨迹规划根据当前速度以及路径距离,可以对后续运动的加速度以及速度进行平滑地规划从而实现运行过程中的平稳力矩控制。
本发明的技术构思为:本发明根据精确的参数辨识对工业机器人进行动力学和运动学建模,以此为基础实现对机器人各关节基于模型的力矩控制:通过逆运动学求解各关节运动角度后,采用正弦加加速度进行各关节加速度规划并通过机器人动力学模型求解控制力矩。采用一种建立虚拟阻抗的方法平滑地避免两个机器人运动时可能出现的碰撞:通过判断关节在运动方向向量法平面上投影的干涉情况以及关节上所选点的距离完成碰撞预测,通过建立关节之间最短距离阻与抗加速度的函数关系进行危险运动区域的速度调节实现各关节的安全运行。
本发明的有益效果主要表现在:能够根据关节运动路程以及当前角速度完成其后续运动的速度、加速度规划;提出了一种检测关节投影干涉情况然后判断关键点距离的方法进行碰撞预测,相较于单纯的最短距离检测能够更有效地完成机器人关节运动过程的碰撞预测;提出了一种根据关节轴线关键点最短距离建立阻抗加速度函数的方法进行避障路径规划,有效实现避障、安全性较高。
附图说明
图1是动力学参数辨识过程图。
图2是正弦加加速度轨迹规划流程图。
图3为碰撞预测流程图。
图4为轨迹规划完整流程图。
具体实施方式
下面结合附图对本发明作进一步描述。
参照图1~图4,一种基于力矩控制的工业机器人避障轨迹规划方法,首先,通过辨识各关节运动学以及惯性参数建立精确的机器人动力学模型;然后,通过逆运动学求解得到运动到终点姿态时各关节角的位移;最后,以关节角位移作为运动路程,采用一种正弦加加速度规划方法进行各关节的速度加速度规划。将速度和加速度代入动力学模型即可求解运动路径中的控制力矩。对于运行过程中可能发的碰撞,本发明采用一种检测关节投影干涉情况然后判断关键点距离的方法进行碰撞预测:将机器人关节向速度向量的法平面投影,若关节投影发生干涉则对关节轴线上各关键点最短距离进行判断,若小于运行时的安全距离则认为存在碰撞的风险。预测到碰撞可能发生,然后对危险关节施加一种阻抗加速度降低关节运动速度从而实现避障。所述规划方法包括以下步骤:
步骤1:工业机器人的动力学参数辨识
本发明采用对机器人整体进行试验的整体辨识法对机器人的动力学参数进行辨识。为了使机器人能实现任意轨迹规划本方法中采用周期性轨迹,每个关节的激励轨迹是正弦和余弦函数的代数和,即有限的傅立叶级数函数,则机器人每个关节的关节位置q规划如下:
其中q表示关节转角,ai、bi表示轨迹的常系数,ωf为轨迹的基频,iωf表示第i阶的频率,t=kTs表示采样时刻,k表示采样个数,Ts表示采样周期。以有限的傅立叶级数函数为机器人待辨识关节的辨识激励轨迹,机器人沿预设轨迹运动过程中,通过测电流法采集关节的驱动力矩;通过安装在电机上的编码器采集关节转角,对转角微分可以得到动态参数中的角速度和角加速度以最小二乘法作为辨识算法可以求解出惯性参数的值:
从而求得精确地动力学模型:其中τ为机器人的驱动力矩;向量D(q)称为机械臂的质量矩阵;为科氏力及离心力项;G(q)为重力项。
步骤2:工业机器人运动学逆解
采用解析解法求解机器人从初始位置到末端位置各关节运动角位移。对于逆运动学求解出现多解和奇异解的问题,除了通过设定各个关节的旋转范围限制来去除无效解和避免奇异解的方法以外,还根据运动能量最小原则选择消耗能量最小的逆解值作为关节的执行量,具体计算方法如下:计算与前一个关节差的平方和,选择计算结果最小的一组关节位置作为下一个关节执行的位置。逆解选择的表达式如下:
步骤3:正弦加加速度关节轨迹规划
采用正弦加加速度规划方法能够对各关节轨迹进行高速、平滑的规划,高效准确地完成从起点到终点的姿态规划。
为了能够实现运动速度以及加速度控制的能力,对于机器人末端操作器的速度,加速度的边界进行限制,具体有如下三点:
1)运动角位移:D
2)运动学上边界:最大角速度ωmax,最大角加速度αmax,最大角加加速度Jmax。
3)运动学下边界:
这里将加加速度设定为正弦函数曲线:
在运动轨迹的限制条件下,运动距离具有两个临界点,其分别为Dmin和Dmin2。在维持加加速度不变的情况下,最大速度和最大加速度都能够达到,运动位移有一个临界最小值,称为Dmin:
其中dmin为初速为零时加速到ωmax时的运动距离daccinc表示加速到最大速度时的运动距离;daccdec表示加ω速度减小到最小值时运动的距离;如果最大加速度未能够达到但是恰好达到了最大速度,运动位移有另一个临界值最小值,被称为Dmin2:
其中dt′为重新计算后的加速运动时间。然后根据运动边界值的不同计算出不同阶段的运动时间,通过对正弦曲线的加加速度积分得到加速度、速度以及位移的运动轨迹。
对轨迹规划的各个步骤以及计算表达式介绍如下:
1:在此步骤中,根据工作任务要求的运动速度和加速度以及运动的位移被初始化。在对距离的大小进行判断后进行各阶段时间的计算。
2:如果任务要求的执行距离D大于最大加速度和最大速度同时能够达到的最小距离Dmin(D≥Dmin2),那么将根据如下公式:
Taccinc表示加速到最大速度时的运动时间;Taccdec表示加ω速度减小到最小值时运动的时间;Tacc表示在加速度增加到最大值恒定阶段时加速过程中运动的时间。Tret表示在负加速度增加到最大值恒定阶段时减速过程中运动的时间。Tvel表示恒速运动的时间。对各个阶段运动的时间进行计算,这是由于速度和加速度都能够充分加速到最大值,所以其中有加速度恒定时间和速度恒定匀速时间需要根据实际距离计算其大小。
3:如果任务要求的运动距离D小于满足最大加速度的最小距离Dmin,但是大于能够达到最大速度距离(D≥Dmin2)这时运动达到的最大加速度以及加速运动时间需要重新计算得:
Taccinc=Taccdec=dt′,Tretinc=Tretdec=dt,Tacc=0,
4:如果任务给定的运动距离D不足以使得速度和加速度都达到给定的速度和加速度(D≤Dmin2)那么在这个步骤中采取先匀速后减速的运动策略:当D>αmaxdt:
当D<αmaxdt时减速运动时间和最大加速度需要根据距离重新计算:
利用正弦加加速度轨迹规划根据当前速度以及路径距离,可以对后续运动的加速度以及速度进行平滑地规划从而实现运行过程中的平稳力矩控制。
步骤4:碰撞预测
对于两个机器人同时作业,其各关节为复杂的圆周运动,在这样的运动状态下单纯的根据关节间距离并不能准确地预判碰撞的发生。本发明采用一种先检测关节投影干涉情况然后判断关键点之间最短距离的方法完成完成运动过程中的碰撞预测。以两个机器人末端关节为例进行说明:
按照关节几何形状,采用半球端面圆柱体包络两个关节从而得到标准化后的关节边界,两球面端点连线为关节轴线,长度为li(i=1,2);圆柱体半径为ri。在各轴线按等间距取个点作为计算关节距离的关键点记为根据关节轴线上所取关键点可得两关节碰撞时的临界距离:
根据dhit设定碰撞预测的极限距离dlim=k1*dhit以及安全距离dsafe=k2*dhit,k1,k2为安全系数可根据实际选取大于一的常数。
根据关节角位移以及瞬时角速度可由正运动学求解得各关键点的笛卡尔坐标以及关节末端速度向量VF。将投影到VF向量的法平面得到关键点的投影点判断各投影点之间的最小距离若:
则说明两个关节在速度向量法平面的投影发生干涉,则进一步判断各关节关键点之间最短距离,若有:
d=min{||P11-P21||,||P11-P22||,||P11-P23||...||P11-P24||}<dsafe
则判定为有可能碰撞的危险状态否则认为是安全运行。
步骤5:阻抗控制避障规划
在上一步中如果关键点之间最短距离d<dsafe,则在后续的运行过程中可能会发生碰撞。本发明采用一种通过判断d与dsafe、dlim之间大小关系确定阻抗加速度αv的方法使各关节减速从而避免障碍:
直到d>dsafe则更新角速度为当前运动角速度ωi以及路径距离Di,然后继续按步骤3的正弦加加速度方法进行速度和加速度规划。
Claims (5)
1.一种基于力矩控制的工业机器人避障轨迹规划方法,其特征在于:
首先,通过辨识各关节运动学以及惯性参数建立机器人动力学模型;
然后,通过逆运动学求解得到运动到终点姿态时各关节角的位移;
最后,以关节角位移作为运动路程,采用一种正弦加加速度规划方法进行各关节的速度加速度规划,将速度和加速度代入动力学模型即可求解运动路径中的控制力矩;
对于运行过程中可能发的碰撞,采用一种检测关节投影干涉情况然后判断关键点距离的方法进行碰撞检测:将机器人关节向速度向量的法平面投影,若关节投影发生干涉则对关节轴线上各关键点最短距离进行判断,若小于运行时的安全距离则认为存在碰撞的风险;检测到碰撞可能发生,然后对危险关节施加一种阻抗加速度降低关节运动速度从而实现避障。
2.如权利要求1所述的基于力矩控制的工业机器人避障轨迹规划方法,其特征在于:所述规划方法包括以下步骤:
步骤1:工业机器人的动力学参数辨识
采用对机器人整体进行试验的整体辨识法对机器人的动力学参数进行辨识,为了使机器人能实现任意轨迹规划,采用周期性轨迹,每个关节的激励轨迹是正弦和余弦函数的代数和,即有限的傅立叶级数函数,则机器人每个关节的关节位置q规划如下:
<mrow>
<mi>q</mi>
<mo>=</mo>
<msub>
<mi>q</mi>
<mn>0</mn>
</msub>
<mo>+</mo>
<munderover>
<mo>&Sigma;</mo>
<mrow>
<mi>i</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mi>n</mi>
</munderover>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mo>(</mo>
<mrow>
<msub>
<mi>&omega;</mi>
<mi>f</mi>
</msub>
<msub>
<mi>ikT</mi>
<mi>s</mi>
</msub>
</mrow>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mo>+</mo>
<munderover>
<mo>&Sigma;</mo>
<mrow>
<mi>i</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mi>n</mi>
</munderover>
<mrow>
<mo>(</mo>
<msub>
<mi>b</mi>
<mi>i</mi>
</msub>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mo>(</mo>
<mrow>
<msub>
<mi>&omega;</mi>
<mi>f</mi>
</msub>
<msub>
<mi>ikT</mi>
<mi>s</mi>
</msub>
</mrow>
<mo>)</mo>
<mo>)</mo>
</mrow>
</mrow>
其中q表示关节转角,ai、bi表示轨迹的常系数,ωf为轨迹的基频,iωf表示第i阶的频率,t=kTs表示采样时刻,k表示采样个数,Ts表示采样周期;
以有限的傅立叶级数函数为机器人待辨识关节的辨识激励轨迹,机器人沿预设轨迹运动过程中,通过测电流法采集关节的驱动力矩;通过安装在电机上的编码器采集关节转角,对转角微分得到动态参数中的角速度和角加速度以最小二乘法作为辨识算法可以求解出惯性参数的值:
<mrow>
<msubsup>
<mi>P</mi>
<mrow>
<mi>i</mi>
<mi>n</mi>
<mi>e</mi>
<mi>r</mi>
</mrow>
<mi>i</mi>
</msubsup>
<mo>=</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mi>I</mi>
<mrow>
<mi>x</mi>
<mi>x</mi>
</mrow>
<mi>i</mi>
</msubsup>
<mo>,</mo>
<msubsup>
<mi>I</mi>
<mrow>
<mi>x</mi>
<mi>y</mi>
</mrow>
<mi>i</mi>
</msubsup>
<mo>,</mo>
<msubsup>
<mi>I</mi>
<mrow>
<mi>x</mi>
<mi>z</mi>
</mrow>
<mi>i</mi>
</msubsup>
<mo>,</mo>
<msubsup>
<mi>I</mi>
<mrow>
<mi>y</mi>
<mi>y</mi>
</mrow>
<mi>i</mi>
</msubsup>
<mo>,</mo>
<msubsup>
<mi>I</mi>
<mrow>
<mi>y</mi>
<mi>z</mi>
</mrow>
<mi>i</mi>
</msubsup>
<mo>,</mo>
<msubsup>
<mi>I</mi>
<mrow>
<mi>z</mi>
<mi>z</mi>
</mrow>
<mi>i</mi>
</msubsup>
<mo>,</mo>
<msubsup>
<mi>H</mi>
<mi>x</mi>
<mi>i</mi>
</msubsup>
<mo>,</mo>
<msubsup>
<mi>H</mi>
<mi>y</mi>
<mi>i</mi>
</msubsup>
<mo>,</mo>
<msubsup>
<mi>H</mi>
<mi>z</mi>
<mi>i</mi>
</msubsup>
<mo>,</mo>
<msup>
<mi>m</mi>
<mi>i</mi>
</msup>
<mo>)</mo>
</mrow>
</mrow>
从而求得精确地动力学模型:其中τ为机器人的驱动力矩;向量D(q)称为机械臂的质量矩阵;为科氏力及离心力项;G(q)为重力项;
步骤2:工业机器人运动学逆解
采用解析解法求解机器人从初始位置到末端位置各关节运动角位移,对于逆运动学求解出现多解和奇异解的问题,除了通过设定各个关节的旋转范围限制来去除无效解和避免奇异解的方法以外,还根据运动能量最小原则选择消耗能量最小的逆解值作为关节的执行量,计算方法如下:计算与前一个关节差的平方和,选择计算结果最小的一组关节位置作为下一个关节执行的位置,逆解选择的表达式如下:
<mrow>
<mi>m</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<munderover>
<mo>&Sigma;</mo>
<mrow>
<mi>i</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mn>6</mn>
</munderover>
<msup>
<mrow>
<mo>(</mo>
<mrow>
<msub>
<mi>p</mi>
<mi>i</mi>
</msub>
<mo>-</mo>
<msub>
<mi>p</mi>
<mn>0</mn>
</msub>
</mrow>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>)</mo>
</mrow>
</mrow>
步骤3:正弦加加速度关节轨迹规划
采用正弦加加速度规划方法能够对各关节轨迹进行高速、平滑的规划,完成从起点到终点的姿态规划;
为了能够实现运动速度以及加速度控制的能力,对于机器人末端操作器的速度,加速度的边界进行限制,有如下三点:
1)运动角位移:D;
2)运动学上边界:最大角速度ωmax,最大角加速度αmax,最大角加加速度Jmax;
3)运动学下边界:
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>&theta;</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mi>f</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mi>&theta;</mi>
<mo>,</mo>
<mi>&omega;</mi>
<mrow>
<mo>(</mo>
<mn>0</mn>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mi>&omega;</mi>
<mo>,</mo>
<mi>&omega;</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mi>f</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mn>0</mn>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>&alpha;</mi>
<mrow>
<mo>(</mo>
<mn>0</mn>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mi>&alpha;</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mi>f</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mn>0</mn>
<mo>,</mo>
<mi>J</mi>
<mrow>
<mo>(</mo>
<mn>0</mn>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mi>J</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mi>f</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mn>0</mn>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
将加加速度设定为正弦函数曲线:
<mrow>
<mi>J</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mi>J</mi>
<mrow>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
</mrow>
</msub>
<mi>sin</mi>
<mrow>
<mo>(</mo>
<mfrac>
<mi>&pi;</mi>
<mrow>
<mi>d</mi>
<mi>t</mi>
</mrow>
</mfrac>
<mo>)</mo>
</mrow>
<mo>,</mo>
<mi>d</mi>
<mi>t</mi>
<mo>=</mo>
<mfrac>
<mrow>
<msub>
<mi>&pi;&alpha;</mi>
<mrow>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
</mrow>
</msub>
</mrow>
<mrow>
<mn>2</mn>
<msub>
<mi>J</mi>
<mrow>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
</mrow>
</msub>
</mrow>
</mfrac>
</mrow>
在运动轨迹的限制条件下,运动距离具有两个临界点,其分别为Dmin和Dmin2,在维持加加速度不变的情况下,最大速度和最大加速度都能够达到,运动位移有一个临界最小值,称为Dmin:
<mrow>
<msub>
<mi>D</mi>
<mrow>
<mi>m</mi>
<mi>i</mi>
<mi>n</mi>
</mrow>
</msub>
<mo>=</mo>
<msub>
<mi>d</mi>
<mrow>
<mi>m</mi>
<mi>i</mi>
<mi>n</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>d</mi>
<mrow>
<mi>a</mi>
<mi>c</mi>
<mi>c</mi>
<mi>d</mi>
<mi>e</mi>
<mi>c</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>d</mi>
<mrow>
<mi>a</mi>
<mi>c</mi>
<mi>c</mi>
<mi>i</mi>
<mi>n</mi>
<mi>c</mi>
</mrow>
</msub>
<mo>+</mo>
<mi>&omega;</mi>
<mi>d</mi>
<mi>t</mi>
<mo>+</mo>
<mfrac>
<mrow>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
</mrow>
</msub>
<mo>-</mo>
<mi>&omega;</mi>
<mo>-</mo>
<msub>
<mi>&alpha;</mi>
<mrow>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
</mrow>
</msub>
<mi>d</mi>
<mi>t</mi>
</mrow>
<msub>
<mi>&alpha;</mi>
<mi>max</mi>
</msub>
</mfrac>
<mo>*</mo>
<mfrac>
<mrow>
<mo>(</mo>
<mi>&omega;</mi>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</mfrac>
</mrow>
其中dmin为初速为零时加速到ωmax时的运动距离daccinc表示加速到最大速度时的运动距离;daccdec表示加ω速度减小到最小值时运动的距离;如果最大加速度未能够达到但是恰好达到了最大速度,运动位移有另一个临界值最小值,被称为Dmin2:
<mrow>
<msub>
<mi>D</mi>
<mrow>
<mi>m</mi>
<mi>i</mi>
<mi>n</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>=</mo>
<msub>
<mi>d</mi>
<mrow>
<mi>m</mi>
<mi>i</mi>
<mi>n</mi>
</mrow>
</msub>
<mo>+</mo>
<msup>
<mrow>
<mo>&lsqb;</mo>
<mfrac>
<mrow>
<mo>(</mo>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>m</mi>
<mi>i</mi>
<mi>n</mi>
</mrow>
</msub>
<mo>-</mo>
<mi>&omega;</mi>
<mo>)</mo>
<mo>*</mo>
<mn>2</mn>
<msub>
<mi>j</mi>
<mrow>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
</mrow>
</msub>
</mrow>
<mi>&pi;</mi>
</mfrac>
<mo>&rsqb;</mo>
</mrow>
<mfrac>
<mn>3</mn>
<mn>2</mn>
</mfrac>
</msup>
<mo>*</mo>
<mfrac>
<mi>&pi;</mi>
<mrow>
<mn>2</mn>
<msup>
<msub>
<mi>J</mi>
<mi>max</mi>
</msub>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
<mo>+</mo>
<mn>2</mn>
<msup>
<mi>&omega;dt</mi>
<mo>&prime;</mo>
</msup>
</mrow>
其中dt′为重新计算后的加速运动时间,然后根据运动边界值的不同计算出不同阶段的运动时间,通过对正弦曲线的加加速度积分得到加速度、速度以及位移的运动轨迹;
步骤4:碰撞检测
对于两个机器人同时作业,按照关节几何形状,采用半球端面圆柱体包络两个关节从而得到标准化后的关节边界,两球面端点连线为关节轴线,长度为li,i=1,2;圆柱体半径为ri,在各轴线按等间距取个点作为计算关节距离的关键点记为根据关节轴线上所取关键点可得两关节碰撞时的临界距离:
<mrow>
<msub>
<mi>d</mi>
<mrow>
<mi>h</mi>
<mi>i</mi>
<mi>t</mi>
</mrow>
</msub>
<mo>=</mo>
<msqrt>
<mrow>
<mo>&lsqb;</mo>
<msubsup>
<mi>r</mi>
<mn>1</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>r</mi>
<mn>2</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msub>
<mi>r</mi>
<mn>2</mn>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>&rsqb;</mo>
</mrow>
</msqrt>
</mrow>
根据dhit设定碰撞检测的极限距离dlim=k1*dhit以及安全距离dsafe=k2*dhit,k1,k2为安全系数;
根据关节角位移以及瞬时角速度可由正运动学求解得各关键点的笛卡尔坐标以及关节末端速度向量VF,将投影到VF向量的法平面得到关键点的投影点判断各投影点之间的最小距离若:
<mrow>
<msup>
<mi>d</mi>
<mo>&prime;</mo>
</msup>
<mo>=</mo>
<mi>m</mi>
<mi>i</mi>
<mi>n</mi>
<mo>{</mo>
<mo>|</mo>
<mo>|</mo>
<msubsup>
<mi>P</mi>
<mn>11</mn>
<mo>&prime;</mo>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>P</mi>
<mn>21</mn>
<mo>&prime;</mo>
</msubsup>
<mo>|</mo>
<mo>|</mo>
<mo>,</mo>
<mo>|</mo>
<mo>|</mo>
<msubsup>
<mi>P</mi>
<mn>11</mn>
<mo>&prime;</mo>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>P</mi>
<mn>22</mn>
<mo>&prime;</mo>
</msubsup>
<mo>|</mo>
<mo>|</mo>
<mo>,</mo>
<mo>|</mo>
<mo>|</mo>
<msubsup>
<mi>P</mi>
<mn>11</mn>
<mo>&prime;</mo>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>P</mi>
<mn>23</mn>
<mo>&prime;</mo>
</msubsup>
<mo>|</mo>
<mo>|</mo>
<mo>...</mo>
<mo>|</mo>
<mo>|</mo>
<msubsup>
<mi>P</mi>
<mrow>
<mn>1</mn>
<msub>
<mi>n</mi>
<mn>1</mn>
</msub>
</mrow>
<mo>&prime;</mo>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>P</mi>
<mrow>
<mn>2</mn>
<msub>
<mi>n</mi>
<mn>2</mn>
</msub>
</mrow>
<mo>&prime;</mo>
</msubsup>
<mo>|</mo>
<mo>|</mo>
<mo>}</mo>
<mo><</mo>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msub>
<mi>r</mi>
<mn>2</mn>
</msub>
</mrow>
则说明两个关节在速度向量法平面的投影发生干涉,则进一步判断各关节关键点之间最短距离,若有:
d=min{‖P11-P21‖,‖P11-P22‖,‖P11-P23‖…‖P11-P24‖}<dsafe
则判定为有可能碰撞的危险状态,否则认为是安全运行;
步骤5:阻抗控制避障规划
如果步骤4中的关键点之间最短距离d<dsafe,则在后续的运行过程中可能会发生碰撞,采用一种通过判断d与dsafe、dlim之间大小关系确定阻抗加速度αv的方法使各关节减速从而避免障碍:
<mrow>
<msub>
<mi>&alpha;</mi>
<mi>v</mi>
</msub>
<mo>=</mo>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mi>d</mi>
<mo>></mo>
<msub>
<mi>d</mi>
<mrow>
<mi>s</mi>
<mi>a</mi>
<mi>f</mi>
<mi>e</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>k</mi>
<mrow>
<mo>(</mo>
<mfrac>
<mn>1</mn>
<mi>d</mi>
</mfrac>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<msub>
<mi>d</mi>
<mrow>
<mi>s</mi>
<mi>a</mi>
<mi>f</mi>
<mi>e</mi>
</mrow>
</msub>
</mfrac>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>d</mi>
<mi>lim</mi>
</msub>
<mo><</mo>
<mi>d</mi>
<mo><</mo>
<msub>
<mi>d</mi>
<mrow>
<mi>s</mi>
<mi>a</mi>
<mi>f</mi>
<mi>e</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>&alpha;</mi>
<mrow>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
</mrow>
</msub>
</mtd>
<mtd>
<mrow>
<mi>d</mi>
<mo><</mo>
<msub>
<mi>d</mi>
<mi>lim</mi>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
直到d>dsafe则更新角速度为当前运动角速度ωi以及路径距离Di,然后继续按步骤3的正弦加加速度方法进行速度和加速度规划。
3.如权利要求2所述的基于力矩控制的工业机器人避障轨迹规划方法,其特征在于:所述步骤3中,如果任务要求的执行距离D大于最大加速度和最大速度同时能够达到的最小距离Dmin,D≥Dmin2,那么将根据如下公式:
<mrow>
<msub>
<mi>T</mi>
<mrow>
<mi>a</mi>
<mi>c</mi>
<mi>c</mi>
<mi>i</mi>
<mi>n</mi>
<mi>c</mi>
</mrow>
</msub>
<mo>=</mo>
<msub>
<mi>T</mi>
<mrow>
<mi>a</mi>
<mi>c</mi>
<mi>c</mi>
<mi>d</mi>
<mi>e</mi>
<mi>c</mi>
</mrow>
</msub>
<mo>=</mo>
<mi>d</mi>
<mi>t</mi>
<mo>=</mo>
<msub>
<mi>T</mi>
<mrow>
<mi>r</mi>
<mi>e</mi>
<mi>t</mi>
<mi>i</mi>
<mi>n</mi>
<mi>c</mi>
</mrow>
</msub>
<mo>=</mo>
<msub>
<mi>T</mi>
<mrow>
<mi>r</mi>
<mi>e</mi>
<mi>t</mi>
<mi>d</mi>
<mi>e</mi>
<mi>c</mi>
</mrow>
</msub>
<mo>,</mo>
<msub>
<mi>T</mi>
<mrow>
<mi>a</mi>
<mi>c</mi>
<mi>c</mi>
</mrow>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
</mrow>
</msub>
<mo>-</mo>
<mi>&omega;</mi>
</mrow>
<msub>
<mi>&alpha;</mi>
<mrow>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
</mrow>
</msub>
</mfrac>
<mo>-</mo>
<mi>d</mi>
<mi>t</mi>
<mo>,</mo>
</mrow>
<mrow>
<msub>
<mi>T</mi>
<mrow>
<mi>v</mi>
<mi>e</mi>
<mi>l</mi>
</mrow>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mi>D</mi>
<mo>-</mo>
<msub>
<mi>D</mi>
<mrow>
<mi>m</mi>
<mi>i</mi>
<mi>n</mi>
</mrow>
</msub>
</mrow>
<msub>
<mi>&omega;</mi>
<mi>max</mi>
</msub>
</mfrac>
<mo>,</mo>
<msub>
<mi>T</mi>
<mrow>
<mi>r</mi>
<mi>e</mi>
<mi>t</mi>
</mrow>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
</mrow>
</msub>
<mi>d</mi>
<mi>t</mi>
</mrow>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
</mrow>
</msub>
</mfrac>
</mrow>
Taccinc表示加速到最大速度时的运动时间;Taccdec表示加ω速度减小到最小值时运动的时间;Tacc表示在加速度增加到最大值恒定阶段时加速过程中运动的时间,Tret表示在负加速度增加到最大值恒定阶段时减速过程中运动的时间,Tvel表示恒速运动的时间。
4.如权利要求2所述的基于力矩控制的工业机器人避障轨迹规划方法,其特征在于:所述步骤3中,如果任务要求的运动距离D小于满足最大加速度的最小距离Dmin,但是大于能够达到最大速度距离,D≥Dmin2;这时运动达到的最大加速度以及加速运动时间需要重新计算得:
Taccinc=Taccdec=dt′,Tretinc=Tretdec=dt,Tacc=0,
<mrow>
<msub>
<mi>T</mi>
<mrow>
<mi>v</mi>
<mi>e</mi>
<mi>l</mi>
</mrow>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mi>D</mi>
<mo>-</mo>
<msub>
<mi>D</mi>
<mrow>
<mi>m</mi>
<mi>i</mi>
<mi>n</mi>
<mn>2</mn>
</mrow>
</msub>
</mrow>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
</mrow>
</msub>
</mfrac>
<mo>,</mo>
<msub>
<mi>T</mi>
<mrow>
<mi>r</mi>
<mi>e</mi>
<mi>t</mi>
</mrow>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
</mrow>
</msub>
<mi>d</mi>
<mi>t</mi>
</mrow>
<msub>
<mi>&omega;</mi>
<mi>max</mi>
</msub>
</mfrac>
</mrow>
<mrow>
<msub>
<mi>&alpha;</mi>
<mrow>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
</mrow>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mi>d</mi>
<mi>t</mi>
<mo>*</mo>
<mn>2</mn>
<msub>
<mi>J</mi>
<mrow>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
</mrow>
</msub>
</mrow>
<mi>&pi;</mi>
</mfrac>
<mo>,</mo>
<msup>
<mi>dt</mi>
<mo>&prime;</mo>
</msup>
<mo>=</mo>
<msqrt>
<mfrac>
<mrow>
<mi>&pi;</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
</mrow>
</msub>
<mo>-</mo>
<mi>&omega;</mi>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mn>2</mn>
<msub>
<mi>J</mi>
<mrow>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
</mrow>
</msub>
</mrow>
</mfrac>
</msqrt>
<mo>.</mo>
</mrow>
5.如权利要求2所述的基于力矩控制的工业机器人避障轨迹规划方法,其特征在于:所述步骤3中,如果任务给定的运动距离D不足以使得速度和加速度都达到给定的速度和加速度,D≤Dmin2,那么采取先匀速后减速的运动策略:
当D>αmaxdt,
<mrow>
<msub>
<mi>T</mi>
<mrow>
<mi>r</mi>
<mi>e</mi>
<mi>t</mi>
</mrow>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mi>&omega;</mi>
<mo>-</mo>
<msub>
<mi>&alpha;</mi>
<mrow>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
</mrow>
</msub>
<mi>d</mi>
<mi>t</mi>
</mrow>
<msub>
<mi>&alpha;</mi>
<mrow>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
</mrow>
</msub>
</mfrac>
<mo>,</mo>
<msub>
<mi>T</mi>
<mrow>
<mi>r</mi>
<mi>e</mi>
<mi>t</mi>
<mi>i</mi>
<mi>n</mi>
<mi>c</mi>
</mrow>
</msub>
<mo>=</mo>
<msub>
<mi>T</mi>
<mrow>
<mi>r</mi>
<mi>e</mi>
<mi>t</mi>
<mi>d</mi>
<mi>e</mi>
<mi>c</mi>
</mrow>
</msub>
<mo>=</mo>
<mi>d</mi>
<mi>t</mi>
<mo>,</mo>
<msub>
<mi>T</mi>
<mrow>
<mi>v</mi>
<mi>e</mi>
<mi>l</mi>
</mrow>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<mi>D</mi>
<mo>-</mo>
<mn>2</mn>
<mi>&omega;</mi>
<mi>d</mi>
<mi>t</mi>
<mo>-</mo>
<msub>
<mi>T</mi>
<mrow>
<mi>r</mi>
<mi>e</mi>
<mi>t</mi>
</mrow>
</msub>
<mi>&omega;</mi>
</mrow>
<mi>&omega;</mi>
</mfrac>
</mrow>
3
当D<αmaxdt时减速运动时间和最大加速度需要根据距离重新计算:
<mrow>
<msub>
<mi>T</mi>
<mrow>
<mi>r</mi>
<mi>e</mi>
<mi>t</mi>
<mi>i</mi>
<mi>n</mi>
<mi>c</mi>
</mrow>
</msub>
<mo>=</mo>
<msub>
<mi>T</mi>
<mrow>
<mi>r</mi>
<mi>e</mi>
<mi>t</mi>
<mi>d</mi>
<mi>e</mi>
<mi>c</mi>
</mrow>
</msub>
<mo>=</mo>
<mi>d</mi>
<mi>t</mi>
<mo>=</mo>
<msqrt>
<mfrac>
<mrow>
<mi>&pi;</mi>
<mi>&omega;</mi>
</mrow>
<mrow>
<mn>2</mn>
<msub>
<mi>J</mi>
<mrow>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
</mrow>
</msub>
</mrow>
</mfrac>
</msqrt>
<mo>,</mo>
<msub>
<mi>&alpha;</mi>
<mrow>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
</mrow>
</msub>
<mo>=</mo>
<mfrac>
<mi>&omega;</mi>
<mrow>
<mi>d</mi>
<mi>t</mi>
</mrow>
</mfrac>
<mo>,</mo>
<msub>
<mi>T</mi>
<mrow>
<mi>v</mi>
<mi>e</mi>
<mi>l</mi>
</mrow>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mi>D</mi>
<mo>-</mo>
<mi>&omega;</mi>
<mi>d</mi>
<mi>t</mi>
</mrow>
<mi>&omega;</mi>
</mfrac>
</mrow>
利用正弦加加速度轨迹规划根据当前速度以及路径距离,对后续运动的加速度以及速度进行平滑地规划从而实现运行过程中的平稳力矩控制。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710321576.1A CN107139171B (zh) | 2017-05-09 | 2017-05-09 | 一种基于力矩控制的工业机器人避障轨迹规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710321576.1A CN107139171B (zh) | 2017-05-09 | 2017-05-09 | 一种基于力矩控制的工业机器人避障轨迹规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107139171A true CN107139171A (zh) | 2017-09-08 |
CN107139171B CN107139171B (zh) | 2019-10-22 |
Family
ID=59776832
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710321576.1A Active CN107139171B (zh) | 2017-05-09 | 2017-05-09 | 一种基于力矩控制的工业机器人避障轨迹规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107139171B (zh) |
Cited By (20)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107957684A (zh) * | 2017-11-17 | 2018-04-24 | 华南理工大学 | 一种基于虚拟速度向量场的机器人三维无碰轨迹规划方法 |
CN108107842A (zh) * | 2017-12-31 | 2018-06-01 | 芜湖哈特机器人产业技术研究院有限公司 | 基于力控制的机器人打磨轨迹估算方法 |
CN108748144A (zh) * | 2018-05-28 | 2018-11-06 | 上海优尼斯工业服务有限公司 | 一种人机协作机械臂的碰撞识别方法 |
CN109108965A (zh) * | 2018-07-27 | 2019-01-01 | 武汉精锋微控科技有限公司 | 一种应用于机械手臂的笛卡尔空间运动预测方法 |
CN109353338A (zh) * | 2018-08-10 | 2019-02-19 | 重庆大数据研究院有限公司 | 一种智能车超车道碰撞概率安全预测方法 |
CN109620410A (zh) * | 2018-12-04 | 2019-04-16 | 微创(上海)医疗机器人有限公司 | 机械臂防碰撞的方法及系统、医疗机器人 |
CN109732644A (zh) * | 2019-01-14 | 2019-05-10 | 深圳市大象机器人科技有限公司 | 一种基于动量模型的机器人在线碰撞检测方法和系统 |
CN110065070A (zh) * | 2019-04-29 | 2019-07-30 | 华中科技大学 | 一种基于动力学模型的机器人自适应阻抗控制系统 |
CN110134065A (zh) * | 2019-05-30 | 2019-08-16 | 西安交通大学 | 一种基于正弦平方加速度前瞻的机床加工轨迹运动规划方法 |
CN110253570A (zh) * | 2019-05-27 | 2019-09-20 | 浙江工业大学 | 基于视觉的工业机械臂人机安全系统 |
CN110696000A (zh) * | 2019-11-21 | 2020-01-17 | 河北工业大学 | 一种机械臂试探感知的避障方法 |
CN110722550A (zh) * | 2018-07-17 | 2020-01-24 | 发那科株式会社 | 机器人系统 |
CN111015656A (zh) * | 2019-12-19 | 2020-04-17 | 佛山科学技术学院 | 一种机器人主动避障的控制方法、装置及存储介质 |
CN111015674A (zh) * | 2020-01-13 | 2020-04-17 | 上海景吾智能科技有限公司 | 一种机器人运动关节控制方法、系统、存储介质及机器人 |
CN111216125A (zh) * | 2019-12-04 | 2020-06-02 | 山东省科学院自动化研究所 | 面向狭窄通道的移动机械臂装置的避障方法及系统 |
CN111670093A (zh) * | 2018-11-06 | 2020-09-15 | 深圳配天智能技术研究院有限公司 | 机器人的运动控制方法、控制系统和存储装置 |
CN112262026A (zh) * | 2018-07-17 | 2021-01-22 | 欧姆龙株式会社 | 加速度调整装置及加速度调整程序 |
CN112987645A (zh) * | 2021-02-23 | 2021-06-18 | 合肥宏晶微电子科技股份有限公司 | 轨迹信息规划方法及装置 |
CN113997291A (zh) * | 2021-11-23 | 2022-02-01 | 南方电网电力科技股份有限公司 | 一种机器人力引导自治控制方法及相关装置 |
CN114571469A (zh) * | 2022-05-05 | 2022-06-03 | 北京科技大学 | 一种机械臂零空间实时避障控制方法及系统 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101332604A (zh) * | 2008-06-20 | 2008-12-31 | 哈尔滨工业大学 | 人机相互作用机械臂的控制方法 |
KR20130112507A (ko) * | 2012-04-04 | 2013-10-14 | 인하대학교 산학협력단 | S* 알고리즘을 이용한 이동로봇의 안전경로계획 수립방법 |
CN104965517A (zh) * | 2015-07-07 | 2015-10-07 | 张耀伦 | 一种机器人笛卡尔空间轨迹的规划方法 |
CN105183009A (zh) * | 2015-10-15 | 2015-12-23 | 哈尔滨工程大学 | 一种冗余机械臂轨迹控制方法 |
WO2016023592A1 (en) * | 2014-08-15 | 2016-02-18 | Abb Technology Ltd | Righting arm model determination |
CN106113034A (zh) * | 2016-06-12 | 2016-11-16 | 哈尔滨工程大学 | 一种六自由度机械臂考虑力约束的轨迹规划方法 |
CN106483964A (zh) * | 2015-08-31 | 2017-03-08 | 中南大学 | 一种基于接触力观测器的机器人柔顺控制方法 |
CN106569491A (zh) * | 2016-10-31 | 2017-04-19 | 江苏华航威泰机器人科技有限公司 | 一种机器人避障轨迹规划方法 |
-
2017
- 2017-05-09 CN CN201710321576.1A patent/CN107139171B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101332604A (zh) * | 2008-06-20 | 2008-12-31 | 哈尔滨工业大学 | 人机相互作用机械臂的控制方法 |
KR20130112507A (ko) * | 2012-04-04 | 2013-10-14 | 인하대학교 산학협력단 | S* 알고리즘을 이용한 이동로봇의 안전경로계획 수립방법 |
WO2016023592A1 (en) * | 2014-08-15 | 2016-02-18 | Abb Technology Ltd | Righting arm model determination |
CN104965517A (zh) * | 2015-07-07 | 2015-10-07 | 张耀伦 | 一种机器人笛卡尔空间轨迹的规划方法 |
CN106483964A (zh) * | 2015-08-31 | 2017-03-08 | 中南大学 | 一种基于接触力观测器的机器人柔顺控制方法 |
CN105183009A (zh) * | 2015-10-15 | 2015-12-23 | 哈尔滨工程大学 | 一种冗余机械臂轨迹控制方法 |
CN106113034A (zh) * | 2016-06-12 | 2016-11-16 | 哈尔滨工程大学 | 一种六自由度机械臂考虑力约束的轨迹规划方法 |
CN106569491A (zh) * | 2016-10-31 | 2017-04-19 | 江苏华航威泰机器人科技有限公司 | 一种机器人避障轨迹规划方法 |
Non-Patent Citations (1)
Title |
---|
胡友忠: "基于动力学的机械臂最优轨迹规划", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
Cited By (30)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107957684A (zh) * | 2017-11-17 | 2018-04-24 | 华南理工大学 | 一种基于虚拟速度向量场的机器人三维无碰轨迹规划方法 |
CN108107842A (zh) * | 2017-12-31 | 2018-06-01 | 芜湖哈特机器人产业技术研究院有限公司 | 基于力控制的机器人打磨轨迹估算方法 |
CN108748144B (zh) * | 2018-05-28 | 2020-06-30 | 上海优尼斯工业服务有限公司 | 一种人机协作机械臂的碰撞识别方法 |
CN108748144A (zh) * | 2018-05-28 | 2018-11-06 | 上海优尼斯工业服务有限公司 | 一种人机协作机械臂的碰撞识别方法 |
US11697206B2 (en) | 2018-07-17 | 2023-07-11 | Omron Corporation | Acceleration adjustment apparatus and non-transitory computer-readable storage medium storing an acceleration adjustment program |
CN112262026B (zh) * | 2018-07-17 | 2023-07-14 | 欧姆龙株式会社 | 加速度调整装置及存储介质 |
CN112262026A (zh) * | 2018-07-17 | 2021-01-22 | 欧姆龙株式会社 | 加速度调整装置及加速度调整程序 |
CN110722550A (zh) * | 2018-07-17 | 2020-01-24 | 发那科株式会社 | 机器人系统 |
CN109108965A (zh) * | 2018-07-27 | 2019-01-01 | 武汉精锋微控科技有限公司 | 一种应用于机械手臂的笛卡尔空间运动预测方法 |
CN109353338B (zh) * | 2018-08-10 | 2022-02-15 | 重庆大数据研究院有限公司 | 一种智能车超车道碰撞概率安全预测方法 |
CN109353338A (zh) * | 2018-08-10 | 2019-02-19 | 重庆大数据研究院有限公司 | 一种智能车超车道碰撞概率安全预测方法 |
CN111670093A (zh) * | 2018-11-06 | 2020-09-15 | 深圳配天智能技术研究院有限公司 | 机器人的运动控制方法、控制系统和存储装置 |
CN111670093B (zh) * | 2018-11-06 | 2023-12-22 | 深圳配天机器人技术有限公司 | 机器人的运动控制方法、控制系统和存储装置 |
CN109620410A (zh) * | 2018-12-04 | 2019-04-16 | 微创(上海)医疗机器人有限公司 | 机械臂防碰撞的方法及系统、医疗机器人 |
CN109732644A (zh) * | 2019-01-14 | 2019-05-10 | 深圳市大象机器人科技有限公司 | 一种基于动量模型的机器人在线碰撞检测方法和系统 |
CN110065070B (zh) * | 2019-04-29 | 2020-09-18 | 华中科技大学 | 一种基于动力学模型的机器人自适应阻抗控制系统 |
CN110065070A (zh) * | 2019-04-29 | 2019-07-30 | 华中科技大学 | 一种基于动力学模型的机器人自适应阻抗控制系统 |
CN110253570A (zh) * | 2019-05-27 | 2019-09-20 | 浙江工业大学 | 基于视觉的工业机械臂人机安全系统 |
CN110134065B (zh) * | 2019-05-30 | 2020-08-18 | 西安交通大学 | 一种基于正弦平方加速度前瞻的机床加工轨迹运动规划方法 |
CN110134065A (zh) * | 2019-05-30 | 2019-08-16 | 西安交通大学 | 一种基于正弦平方加速度前瞻的机床加工轨迹运动规划方法 |
CN110696000A (zh) * | 2019-11-21 | 2020-01-17 | 河北工业大学 | 一种机械臂试探感知的避障方法 |
CN110696000B (zh) * | 2019-11-21 | 2020-12-01 | 河北工业大学 | 一种机械臂试探感知的避障方法 |
CN111216125A (zh) * | 2019-12-04 | 2020-06-02 | 山东省科学院自动化研究所 | 面向狭窄通道的移动机械臂装置的避障方法及系统 |
CN111015656A (zh) * | 2019-12-19 | 2020-04-17 | 佛山科学技术学院 | 一种机器人主动避障的控制方法、装置及存储介质 |
CN111015674B (zh) * | 2020-01-13 | 2021-05-11 | 上海景吾智能科技有限公司 | 一种机器人运动关节控制方法、系统、存储介质及机器人 |
CN111015674A (zh) * | 2020-01-13 | 2020-04-17 | 上海景吾智能科技有限公司 | 一种机器人运动关节控制方法、系统、存储介质及机器人 |
CN112987645A (zh) * | 2021-02-23 | 2021-06-18 | 合肥宏晶微电子科技股份有限公司 | 轨迹信息规划方法及装置 |
CN113997291A (zh) * | 2021-11-23 | 2022-02-01 | 南方电网电力科技股份有限公司 | 一种机器人力引导自治控制方法及相关装置 |
CN114571469A (zh) * | 2022-05-05 | 2022-06-03 | 北京科技大学 | 一种机械臂零空间实时避障控制方法及系统 |
CN114571469B (zh) * | 2022-05-05 | 2022-07-26 | 北京科技大学 | 一种机械臂零空间实时避障控制方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN107139171B (zh) | 2019-10-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107139171A (zh) | 一种基于力矩控制的工业机器人避障轨迹规划方法 | |
CN107160389B (zh) | 一种工业机器人的力矩控制方法 | |
WO2017219639A1 (zh) | 一种机械臂的运动轨迹规划方法、装置及机器人 | |
CN106625671A (zh) | 一种空间机器人抓捕翻滚目标的最优轨迹规划方法 | |
CN107756400B (zh) | 一种基于旋量理论的6r机器人逆运动学几何求解方法 | |
CN107336230B (zh) | 一种基于投影和距离判断的工业机器人碰撞预测方法 | |
CN105676642B (zh) | 一种六自由度机器人工位布局与运动时间协同优化方法 | |
CN108890650A (zh) | 基于动力学参数辨识的ptp加速度优化方法及装置 | |
Polverini et al. | Sensorless and constraint based peg-in-hole task execution with a dual-arm robot | |
CN108549324B (zh) | 用于高速分拣系统的工件跟随抓取轨迹规划方法及系统 | |
CN105988366A (zh) | 一种空间机器人最小基座扰动轨迹规划方法 | |
CN110347154B (zh) | 基于模拟控制系统的高精度地图路径规划方法 | |
CN112486183A (zh) | 一种室内移动机器人的路径规划算法 | |
CN115213898A (zh) | 一种基于逆解多目标优化的焊接机器人笛卡尔空间轨迹规划方法 | |
CN113715027A (zh) | 7自由度双臂协作机器人防止自碰撞轨迹规划方法及系统 | |
CN105904458B (zh) | 一种基于复杂操作任务的非完整遥操作约束控制方法 | |
Zhang et al. | Kuka youBot arm shortest path planning based on geodesics | |
Lin et al. | The arm planning with dynamic movement primitive for humanoid service robot | |
CN114367975A (zh) | 串联工业机器人控制算法的验证系统 | |
CN105965508B (zh) | 一种机器人宇航员稳定攀爬控制方法 | |
Puriyanto et al. | Implementation of improved artificial potential field path planning algorithm in differential drive mobile robot | |
Zhai et al. | Trajectory planning of NAO robot arm based on target recognition | |
Yu et al. | Modelling and adaptive control of NAO robot arm | |
Wu et al. | Simulation Design of a Tomato Picking Manipulator | |
Liang et al. | Research on the intelligent recognition system of printing roller surface defects based on machine vision |
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 |