CN114347017B - 基于平面投影的吸附式移动加工机器人曲面运动控制方法 - Google Patents
基于平面投影的吸附式移动加工机器人曲面运动控制方法 Download PDFInfo
- Publication number
- CN114347017B CN114347017B CN202111517319.8A CN202111517319A CN114347017B CN 114347017 B CN114347017 B CN 114347017B CN 202111517319 A CN202111517319 A CN 202111517319A CN 114347017 B CN114347017 B CN 114347017B
- Authority
- CN
- China
- Prior art keywords
- type mobile
- adsorption type
- mobile processing
- processing robot
- motion
- 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.)
- Active
Links
- 238000001179 sorption measurement Methods 0.000 title claims abstract description 59
- 238000000034 method Methods 0.000 title claims abstract description 23
- 230000001133 acceleration Effects 0.000 claims description 10
- 230000008569 process Effects 0.000 claims description 2
- 239000011159 matrix material Substances 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 230000007547 defect Effects 0.000 description 2
- 230000006872 improvement Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007123 defense Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Landscapes
- Manipulator (AREA)
Abstract
本发明属于工业机器人相关技术领域,其公开了一种基于平面投影的吸附式移动加工机器人曲面运动控制方法,该方法包括获取三维曲面上机器人运动的运动路径点;将运动路径点向三维曲面的AABB包围盒面积最大的二维坐标平面投影获得投影路径点;对相邻投影路径点进行速度规划,获得机器人的运动轨迹在二维坐标平面上的理想投影轨迹;将机器人的三维姿态信息投影至二维坐标平面获得实际投影状态变量;将理想投影轨迹与实际投影状态变量做差得到误差状态变量,构建以误差状态变量与速度控制变量为参数的代价函数,采用代价函数的最优解对机器人当前时刻的速度进行修正。该方法为高精度、高质量的吸附式移动加工提供高精度控制基础。
Description
技术领域
本发明属于工业机器人相关技术领域,更具体地,涉及一种基于平面投影的吸附式移动加工机器人曲面运动控制方法。
背景技术
大型复杂构件在国防、交通、能源等国家重要战略领域有着广泛应用,但由于其尺寸巨大,传统的机器人加工方式难以全型面覆盖。吸附式移动加工机器人因运动灵活,摆脱了空间维度限制等优势在大型复杂构件加工领域有着巨大应用潜力。
现有技术中三维曲面约束下机器人运动控制需要获知三维曲面参数方程,通过曲面参数方程来求解机器人的运动路径,由于大型复杂构件曲面形状复杂,求解曲面参数方程工作量极大,并且误差大,因此亟需设计一种简单高效的机器人控制方法,以便于工业化应用。
发明内容
针对现有技术的以上缺陷或改进需求,本发明提供了一种基于平面投影的吸附式移动加工机器人曲面运动控制方法,其目的在于控制吸附式移动加工机器人在大型复杂构件上精准运动,为高精度、高质量的吸附式移动加工提供高精度控制基础。
为实现上述目的,按照本发明的一个方面,提供了一种基于平面投影的吸附式移动加工机器人曲面运动控制方法,所述方法包括:S1:获取三维曲面上吸附式移动加工机器人将要运动的运动路径点s1,s2...sn;S2:将所述运动路径点s1,s2...sn向所述三维曲面AABB包围盒面积最大的二维坐标平面投影获得所述运动路径点s1,s2...sn的投影路径点s′1,s′2...s′n;S3:对相邻投影路径点s′i与s′i+1之间进行速度规划,获得吸附式移动加工机器人的运动轨迹在所述二维坐标平面上的理想投影轨迹;S4:获取所述吸附式移动加工机器人在三维曲面上的三维姿态信息,将所述三维姿态信息投影至所述二维坐标平面获得所述吸附式移动加工机器人在当前时刻的实际投影状态变量;S5:将所述理想投影轨迹与实际投影状态变量做差得到误差状态变量,构建以所述误差状态变量与速度控制变量为参数的代价函数;S6:获取所述代价函数的最优解,采用所述最优解对所述吸附式移动加工机器人当前时刻的速度进行修正,以实现所述吸附式移动加工机器人在三维曲面约束下的运动控制。
优选地,步骤S3中具体为对投影路径点s′i与s′i+1之间进行梯形速度规划。
优选地,所述梯形速度规划公式如下:
其中,s(t)为t时刻的运动路径长度,T为运动总时间,t0为加速时间,a为机器人加速运动过程中的加速度。
优选地,步骤S6获取所述代价函数的最优解具体为:获取所述代价函数的最优解进而获得最优控制变量序列,采用所述最优控制变量序列的第一个控制变量向量作为所述吸附式移动加工机器人的速度控制变量。
优选地,所述代价函数Φ(k)的表达式为:
其中,k为当前时刻,为k+j时刻所述吸附式移动加工机器人在二维坐标平面的误差状态变量预测值,Q为状态误差变量的权重系数,R为控制变量增量的权重系数,Np为预测时域,Nc为控制时域,/>为k+j-1时刻所述吸附式移动加工机器人的速度控制变量增量,其中,/>为k+j-1时刻所述吸附式移动加工机器人相对本体坐标系横向速度控制量增量,/>为k+j-1时刻所述吸附式移动加工机器人相对本体坐标系纵向速度控制量增量,/>为k+j-1时刻所述吸附式移动加工机器人相对本体坐标系旋转角速度控制量增量。
优选地,所述控制变量增量序列为代价函数Φ(k)的最优解,其表达式为:
优选地,采用QP二次解算所述代价函数的最优解。
总体而言,通过本发明所构思的以上技术方案与现有技术相比,本发明提供的基于平面投影的吸附式移动加工机器人曲面运动控制方法具有如下有益效果:
1.本申请将吸附式移动加工机器人在曲面上的三维运动转化为二维运动,进而使得较难控制的三维运动控制问题转化为二维运动控制问题,避开了求解大型复杂构件等变曲率曲面难以获得曲面参数方程的不足,解算更加简单,显著降低了三维曲面上机器人的控制难度;
2.对相邻投影路径点之间进行梯形速度规划可以实现机器人运动的平稳性,速度平滑过渡,运动更加平稳;
3.通过构建并解算代价函数来获得最优速度控制变量,建模简单,抗干扰能力强,控制精度高。
附图说明
图1是本实施例吸附式移动加工机器人的结构示意图;
图2是基于平面投影的吸附式移动加工机器人曲面运动控制方法的步骤图;
图3是本实施例大型风电叶片曲面及路径点规划示意图;
图4是本实施例大型风电叶片曲面及路径点在OXZ平面的投影;
图5是本实施例三轮全向轮运动学模型示意图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。此外,下面所描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。
本发明提供了一种基于平面投影的吸附式移动加工机器人曲面运动控制方法,本实施例中的吸附式移动加工机器人具体为具有三轮全向轮运动平台,如图1所示,包含三个120度均布的全向驱动轮1和三个120度均布的柔性吸附腔2,三维曲面为大型复杂构件曲面,在本实施例中三维曲面为大型风电叶片曲面,该运动控制方法包括如下步骤S1~S6,如图2所示。
S1:获取三维曲面上吸附式移动加工机器人将要运动的运动路径点s1,s2...sn。
首先将三维曲面置于坐标系中,如图3所示,将三维曲面置于坐标系OXYZ中,然后,根据具体的加工需要,确定吸附式移动加工机器人在三维曲面上的运动路径点s1,s2...sn。
S2:将所述运动路径点s1,s2...sn向所述三维曲面的AABB包围盒面积最大的二维坐标平面投影得到获得所述运动路径点s1,s2...sn的投影路径点s′1,s′2...s′n。
由于三维曲面的曲面方程为f(x,y,z)=0,所以在三维曲面约束下确定了x和z的坐标即可唯一确定y的坐标。由此可以将三维运动问题简化为二维曲面问题。
所述三维曲面的AABB包围盒面积最大的二维坐标平面在本实施例中为OXZ平面,所以将三维运动路径点s1,s2...sn向三维空间中的OXZ平面投影获得对应的投影路径点s′1,s′2...s′n,如图4所示。
S3:对相邻投影路径点s′i与s′i+1之间进行速度规划,获得吸附式移动加工机器人的运动轨迹在所述二维坐标平面上的理想投影轨迹。
对相邻的两个投影路径点之间的速度进行规划,进一步优选为梯形速度规划策略,所述梯形速度规划公式如下:
其中,s(t)为t时刻的运动路径长度,T为运动总时间,t0为加速时间,a为机器人加速运动过程中的加速度。由此即可得到机器人三维理想轨迹点在OXZ平面上的投影,如图4所示。
基于以上速度规划即可获得当前时刻对应的投影轨迹点理想状态变量xr=[xr zrθr]T。
S4:获取所述吸附式移动加工机器人在三维曲面上的三维姿态信息,将所述三维姿态信息投影至所述二维坐标平面获得所述吸附式移动加工机器人在当前时刻的实际投影状态变量。
可以采用运动捕捉***实时获取吸附式移动加工机器人在三维曲面上运动的三维姿态信息,将三维姿态信息投影至平面OXZ上即可获得当前时刻实际投影状态变量x=[xz θ]T。
S5:将所述理想投影轨迹与实际投影状态变量做差得到误差状态变量,构建以所述误差状态变量与速度控制变量为参数的代价函数。
具体为将所述理想投影轨迹与实际投影状态变量做差获得误差状态变量。构建状态误差变量与控制变量增量的代价函数,获取所述代价函数的最优解进而获得最优控制变量序列,将最优控制变量序列的第一个控制变量向量作为机器人的速度控制变量。
所述代价函数Φ(k)的表达式为:
其中,k为当前时刻,Np为预测时域,Nc为控制时域,为k+j时刻所述吸附式移动加工机器人在二维坐标平面的误差状态变量预测值,Q为状态误差变量的权重系数,R为控制变量增量的权重系数,/>为k+j-1时刻所述吸附式移动加工机器人的速度控制变量增量,其中,/>为k+j-1时刻所述吸附式移动加工机器人相对本体坐标系横向速度控制量增量,/>为k+j-1时刻所述吸附式移动加工机器人相对本体坐标系纵向速度控制量增量,/>为k+j-1时刻所述吸附式移动加工机器人相对本体坐标系旋转角速度控制量增量。
具体的解算过程如下:
将所述代价函数化为二次标准型:
其中,
进一步的,本实施例中,令Np=Nc=N,其中控制矩阵和输出矩阵/>分别为:
其中,A(*|k)和B(*|k)可以采用如下方式获得:
建立吸附式移动加工机器人的运动学模型具体坐标系描述如下附图5所示,OXwZw为固定世界坐标系,OXmZm为机器人本体坐标系。
在理想点机器人运动学模型为:
在理想点将机器人运动学模型泰勒展开得:
令将式(3)减式(1)得:/>
进行离散化后得:
其中,为k+1时刻吸附式移动加工机器人在OXZ平面上的误差状态变量,/>为k时刻吸附式移动加工机器人在OXZ平面上的误差状态变量,/>为k时刻所述吸附式移动加工机器人的控制变量增量,其中,/>为k时刻所述吸附式移动加工机器人相对本体坐标系横向速度控制量增量,/>为k时刻所述吸附式移动加工机器人相对本体坐标系纵向速度控制量增量,/>为k时刻所述吸附式移动加工机器人相对本体坐标系旋转加速度控制量增量,A(k)=I+TA为离散化机器人状态转移矩阵,B(k)=TB为离散化输入矩阵,T为控制时间间隔,I为单位矩阵。
由上述的A(k)和B(k)即可预测解算得到A(*|k)和B(*|k)。
所述最优控制变量序列为代价函数Φ(k)的最优解:
进一步采用QP二次解算所述代价函数的最优解。将所述最优控制变量的第一个向量作为机器人得速度控制变量。
S6:获取所述代价函数的最优解,采用所述最优解对所述吸附式移动加工机器人当前时刻的速度进行修正,以实现所述吸附式移动加工机器人在三维曲面约束下的运动控制。
获取所述代价函数的最优解进而获得最优控制变量序列,采用所述最优控制变量序列的第一个控制变量向量作为所述吸附式移动加工机器人速度控制变量,将第一控制变量向量作用于机器人即可获得优化后机器人的速度。
本领域的技术人员容易理解,以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。
Claims (3)
1.一种基于平面投影的吸附式移动加工机器人曲面运动控制方法,其特征在于,所述方法包括:
S1:获取三维曲面上吸附式移动加工机器人将要运动的运动路径点s1,s2...sn;
S2:将所述运动路径点s1,s2...sn向所述三维曲面的AABB包围盒面积最大的二维坐标平面投影,获得所述运动路径点s1,s2...sn的投影路径点s′1,s'2...s'n;
S3:对相邻投影路径点s′i与s′i+1之间进行速度规划,获得吸附式移动加工机器人的运动轨迹在所述二维坐标平面上的理想投影轨迹;步骤S3中具体为对投影路径点s′i与s′i+1之间进行梯形速度规划,所述梯形速度规划公式如下:
其中,s(t)为t时刻的运动路径长度,T为运动总时间,t0为加速时间,a为机器人加速运动过程中的加速度;
S4:获取所述吸附式移动加工机器人在三维曲面上的三维姿态信息,将所述三维姿态信息投影至所述二维坐标平面获得所述吸附式移动加工机器人在当前时刻的实际投影状态变量;
S5:将所述理想投影轨迹与实际投影状态变量做差得到误差状态变量,构建以所述误差状态变量与速度控制变量为参数的代价函数,所述代价函数Φ(k)的表达式为:
其中,k为当前时刻,为k+j时刻所述吸附式移动加工机器人在二维坐标平面的误差状态变量预测值,Q为状态误差变量的权重系数,R为控制变量增量的权重系数,为k+j-1时刻所述吸附式移动加工机器人的速度控制变量增量,其中,/>为k+j-1时刻所述吸附式移动加工机器人相对本体坐标系横向速度控制量增量,/>为k+j-1时刻所述吸附式移动加工机器人相对本体坐标系纵向速度控制量增量,/>为所述吸附式移动加工机器人相对本体坐标系旋转角速度控制量增量,Np为预测时域,Nc为控制时域;
S6:获取所述代价函数的最优解,采用所述最优解对所述吸附式移动加工机器人当前时刻的速度进行修正,以实现所述吸附式移动加工机器人在三维曲面约束下的运动控制,获取所述代价函数的最优解具体为:获取所述代价函数的最优解进而获得最优控制变量序列,采用所述最优控制变量序列的第一个控制变量向量作为所述吸附式移动加工机器人速度控制变量。
2.根据权利要求1所述的方法,其特征在于,所述最优控制变量序列为代价函数Φ(k)的最优解,其表达式为:
3.根据权利要求1或2所述的方法,其特征在于,采用QP二次解算所述代价函数的最优解。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111517319.8A CN114347017B (zh) | 2021-12-08 | 2021-12-08 | 基于平面投影的吸附式移动加工机器人曲面运动控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111517319.8A CN114347017B (zh) | 2021-12-08 | 2021-12-08 | 基于平面投影的吸附式移动加工机器人曲面运动控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114347017A CN114347017A (zh) | 2022-04-15 |
CN114347017B true CN114347017B (zh) | 2024-02-02 |
Family
ID=81099300
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111517319.8A Active CN114347017B (zh) | 2021-12-08 | 2021-12-08 | 基于平面投影的吸附式移动加工机器人曲面运动控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114347017B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114035591B (zh) * | 2021-11-15 | 2023-05-02 | 哈尔滨工程大学 | 一种水下变曲率壁面运动机器人的运动切换控制方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0631663A (ja) * | 1992-07-17 | 1994-02-08 | Fujitsu Ltd | 倣い制御ロボットの軌道制御装置 |
CN1883887A (zh) * | 2006-07-07 | 2006-12-27 | 中国科学院力学研究所 | 一种基于虚拟场景的机器人避障路径规划方法 |
CN109708654A (zh) * | 2018-12-29 | 2019-05-03 | 百度在线网络技术(北京)有限公司 | 一种路径规划方法和路径规划*** |
CN111369593A (zh) * | 2020-03-16 | 2020-07-03 | 梅卡曼德(北京)机器人科技有限公司 | 玻璃涂胶方法、装置、电子设备和存储介质 |
CN113447039A (zh) * | 2021-07-03 | 2021-09-28 | 湖南汇视威智能科技有限公司 | 一种基于测绘信息的高精度道路最短路径计算方法 |
-
2021
- 2021-12-08 CN CN202111517319.8A patent/CN114347017B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0631663A (ja) * | 1992-07-17 | 1994-02-08 | Fujitsu Ltd | 倣い制御ロボットの軌道制御装置 |
CN1883887A (zh) * | 2006-07-07 | 2006-12-27 | 中国科学院力学研究所 | 一种基于虚拟场景的机器人避障路径规划方法 |
CN109708654A (zh) * | 2018-12-29 | 2019-05-03 | 百度在线网络技术(北京)有限公司 | 一种路径规划方法和路径规划*** |
CN111369593A (zh) * | 2020-03-16 | 2020-07-03 | 梅卡曼德(北京)机器人科技有限公司 | 玻璃涂胶方法、装置、电子设备和存储介质 |
CN113447039A (zh) * | 2021-07-03 | 2021-09-28 | 湖南汇视威智能科技有限公司 | 一种基于测绘信息的高精度道路最短路径计算方法 |
Non-Patent Citations (3)
Title |
---|
基于量子粒子群优化的在线航迹规划;过金超;黄心汉;王延峰;崔光照;;计算机科学(第07期);全文 * |
基于量子粒子群优化的无人飞行器路径规划;过金超;崔光照;王延峰;;火力与指挥控制(第12期);全文 * |
空间机器人路径规划综合优化方法;金宗耀;谭春林;;航天器工程(第02期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN114347017A (zh) | 2022-04-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107490965B (zh) | 一种空间自由漂浮机械臂的多约束轨迹规划方法 | |
CN106647282B (zh) | 一种考虑末端运动误差的六自由度机器人轨迹规划方法 | |
CN102795544B (zh) | 基于轨迹在线规划的桥式吊车高效消摆控制方法 | |
Chen et al. | A multi-objective trajectory planning method based on the improved immune clonal selection algorithm | |
CN106055522A (zh) | 冗余空间机械臂最小基座姿态扰动的轨迹规划方法 | |
CN105138000A (zh) | 最优化基座位姿扰动的七自由度空间机械臂轨迹规划方法 | |
Meng et al. | Vibration suppression control of free-floating space robots with flexible appendages for autonomous target capturing | |
CN107479566A (zh) | 基于三段式路径规划的挠性卫星姿态控制方法 | |
CN108638068B (zh) | 一种携带冗余度机械臂的飞行机器人控制***设计方法 | |
CN110405762A (zh) | 一种基于空间二阶倒立摆模型的双足机器人姿态控制方法 | |
Yang et al. | Smooth trajectory planning along Bezier curve for mobile robots with velocity constraints | |
CN114347017B (zh) | 基于平面投影的吸附式移动加工机器人曲面运动控制方法 | |
CN114370793A (zh) | 一种火箭子级返回与垂直着陆制导方法 | |
CN115480583A (zh) | 飞行作业机器人的视觉伺服跟踪与阻抗控制方法 | |
Yu et al. | Minimum jerk trajectory generation of a quadrotor based on the differential flatness | |
Aneesh | Tracking Controller of mobile robot | |
Gu et al. | Dexterous obstacle-avoidance motion control of Rope Driven Snake Manipulator based on the bionic path following | |
CN108227723A (zh) | 一种水下机器人及其稳定性分析及结构优化的应用方法 | |
Ning et al. | Time-optimal point stabilization control for WIP vehicles using quasi-convex optimization and B-spline adaptive interpolation techniques | |
CN113867157B (zh) | 一种控制补偿的最优轨迹规划方法、设备及存储设备 | |
Zhu et al. | Use of dynamic scaling for trajectory planning of floating pedestal and manipulator system in a microgravity environment | |
CN114840947A (zh) | 一种带约束的三自由度机械臂动力学模型 | |
CN114800521A (zh) | 一种带约束的三自由度机械臂固定路径点运动控制*** | |
CN113359462A (zh) | 一种基于扰动解耦与补偿的仿生眼稳像***及方法 | |
Li et al. | Path-following control for multi-axle car-like wheeled mobile robot with nonholonomic constraint |
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 |