一种龙门式吊装机器人工作单元中附加轴运动规划方法技术

本发明专利技术涉及一种龙门式吊装机器人工作单元中附加轴运动规划方法。在添加龙门式外部直线附加轴与工业机器人的6个关节联动的冗余工作单元和固定的工作平台基础上，对沿附加轴上固连机器人底座的滑台运动方向单调变化的一段加工轨迹点，手动选取此加工轨迹点上的两个点作为优先区间的端点。通过点到空间直线的投影原理，获得滑台移动起始点。通过设定滑台步长，获得滑台移动中间点及滑台移动终止点，即得到滑台与优先区间内加工轨迹点对应的各移动位置到附加轴零点的距离。机器人加工优先区间内的轨迹点时滑台的移动优先于机器人各关节的运动。所述方法可减少机器人关节变化幅度，使得机器人运动连续平稳，适用于机器人加工连续而密集的轨迹点。

【技术实现步骤摘要】

本专利技术涉及一种龙门式吊装机器人工作单元中附加轴运动规划方法，属于工业机器人冗余工作空间控制领域。
技术介绍
随着工业机器人逐渐在工业生产中被广泛应用，扩大工业机器人的加工范围这一需求日益凸显。在许多机器人应用领域，如基于工业机器人的大型模具倒角表面感应淬火系统中，由于工作对象尺寸较大，因此需要为工业机器人添加外部直线附加轴来扩大机器人的工作范围。并且，采用机器人倒吊安装在龙门式附加轴上的方式，可有效应用于以往不能使用的机器人安装区域。经对现有技术的文献检索发现，目前控制机器人附加轴运动模式有分站式任务规划与控制方法，即机器人只在附加轴的几个特定的站位工作，这种方法虽然能实现对产品整个加工范围的覆盖，但在某站点上加工其对应加工范围内的连续轨迹点时，机器人自身的关节变化幅度大，且当需要加工下一站点对应的加工范围时，需等待机器人从一个站点移动到另一个站点，因此该方法适合的作业对象是大型工件上较离散的轨迹点，如基于工业机器人的自动钻铆。但针对大型工件上连续而密集的加工轨迹点作业，如对大型模具倒角表面感应淬火则需要工业机器人处于连续的平稳运动状态。
技术实现思路
本专利技术的目的是提供一种龙门式吊装机器人工作单元中附加轴运动规划方法，在添加龙门式外部直线附加轴与工业机器人的6个关节联动的冗余工作单元和固定的工作平台基础上，对沿附加轴上固连机器人底座的滑台运动方向单调变化的一段加工轨迹点，通过手动选取此加工轨迹点上的两个点a、b作为此区间的端点，机器人加工区间[a,b]内的轨迹点时滑台的移动优先于机器人各关节的运动。在此基础上规划满足附加轴运动范围的滑台与加工轨迹点对应的各移动位置关系。所述方法可减少机器人关节变化幅度，使得机器人运动连续平稳，适用于机器人加工连续而密集的轨迹点。为达到上述目的，本专利技术采用如下技术方案：一种龙门式吊装机器人工作单元中附加轴运动规划方法，使得附加轴滑台的移动优先于机器人各关节的运动，该附加轴包括直线导轨和滑台，该方法包括如下步骤：步骤1：在工作台上建立用户坐标系{OUXUYUZU本文档来自技高网...

【技术保护点】
一种龙门式吊装机器人工作单元中附加轴运动规划方法，该附加轴包括直线导轨(1)和滑台(2)，其特征在于，该方法包括如下步骤：步骤1：在工作台(4)上建立用户坐标系{OU XU YU ZU}；在直线导轨(1)的零点M处建立导轨零点坐标系{OH XH YH ZH}，其中OX轴线方向，即直线导轨(1)轴线方向为滑台(2)运动方向；在滑台(2)下表面中心处建立滑台坐标系{OA XA YA ZA}；步骤2：在沿滑台(2)运动方向单调变化的一段加工轨迹点(5)中手动选取两个轨迹点a、b作为区间的端点；步骤3：根据点到空间直线的投影原理，将区间[a,b]的左端点a投影到直线导轨(1)轴线上，获得滑台(2)移动起始点A；根据直线导轨(1)的零点M(x1,y1,z1)和直线导轨(1)的终止点N(x2,y2,z2)，直线导轨(1)轴线直线参数方程为：x＝x1+mty＝y1+ntz＝z1+lt其中，m＝x2‑x1，n＝y2‑y1，l＝z2‑z1，t为参数；则滑台(2)移动起始点在直线导轨(1)轴线上表示为A(x1+mt,y1+nt,z1+lt)，设区间[a,b]的左端点为a(x3,y3,z3)，参数t为：t=m(x3-x1)+n(y3-y1)+l(z3-z1)m2+n2+l2;]]>步骤4：判断滑台(2)移动起始点A(x1+mt,y1+nt,z1+lt)是否在以直线导轨(1)零点M和终止点N为端点的直线段MN上；若点A不在线段MN上，则回到步骤2，重新选取区间[a,b]的左端点a；若点A在线段MN上，根据两点间距离公式，计算得滑台(2)移动起始点A到直线导轨(1)零点M的距离D1：D1=(x1+mt-x1)2+(y1+nt-y1)2+(z1+lt-z1)2]]>步骤5：通过区间[a,b]获得该区间内轨迹点的个数n，从滑台(2)移动起始点A处沿滑台(2)移动方向叠加n‑1个滑台(2)移动的步长△d，获得n‑2个滑台(2)移动中间点到直线导轨(1)零点M的距离D2，D3，……Dn‑1，以及滑台(2)移动终止点B到直线导轨(1)零点M的距离Dn；机器人加工区间[a,b]内轨迹点使滑台坐标系{OA XA YA ZA}原点依次与滑台(2)移动起始点A、n‑2个滑台(2)移动中间点、滑台(2)移动终止点B重合，即得到滑台(2)与区间[a,b]内加工轨迹点对应的各移动位置到直线导轨(1)零点M的距离D；步骤6：根据直线导轨(1)行程L，判断滑台(2)移动终止点B到直线导轨(1)零点M的距离Dn是否超出直线导轨(1)行程L，若Dn>L，则回到步骤5，减小步长△d，直至Dn<L或Dn＝L；若Dn<L或Dn＝L，即建立滑台(2)与区间[a,b]内加工轨迹点对应的各移动位置关系；步骤7：对区间[a,b]以外的加工轨迹点，加工离端点a近的轨迹点时，滑台(2)在移动起始点A处；加工离端点b近的轨迹点时，滑台(2)在移动终止点B处，至此，得到滑台(2)与所有加工轨迹点对应的各移动位置到直线导轨(1)零点M的距离D值，即完成建立龙门式吊装机器人工作单元中附加轴运动规划模型。...

【技术特征摘要】
1.一种龙门式吊装机器人工作单元中附加轴运动规划方法，该附加轴包括直线导轨(1)和滑台(2...

【专利技术属性】
技术研发人员：沈南燕，鞠然，李静，钱晖，禹壮，童梁，
申请(专利权)人：上海大学，
类型：发明
国别省市：上海;31