CN112223788B - 纤维自动铺放系统以及其铺放轨迹的规划方法 - Google Patents
纤维自动铺放系统以及其铺放轨迹的规划方法 Download PDFInfo
- Publication number
- CN112223788B CN112223788B CN202010934994.XA CN202010934994A CN112223788B CN 112223788 B CN112223788 B CN 112223788B CN 202010934994 A CN202010934994 A CN 202010934994A CN 112223788 B CN112223788 B CN 112223788B
- Authority
- CN
- China
- Prior art keywords
- laying
- mechanical arm
- controller
- tension
- automatic fiber
- 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
- 239000000835 fiber Substances 0.000 title claims abstract description 55
- 238000000034 method Methods 0.000 title claims abstract description 41
- 230000008569 process Effects 0.000 claims abstract description 16
- 238000004804 winding Methods 0.000 claims description 27
- 238000010438 heat treatment Methods 0.000 claims description 13
- 238000004364 calculation method Methods 0.000 claims description 9
- 230000006835 compression Effects 0.000 claims description 9
- 238000007906 compression Methods 0.000 claims description 9
- 230000008878 coupling Effects 0.000 claims description 9
- 238000010168 coupling process Methods 0.000 claims description 9
- 238000005859 coupling reaction Methods 0.000 claims description 9
- 239000002131 composite material Substances 0.000 claims description 8
- 238000005457 optimization Methods 0.000 claims description 7
- 230000008859 change Effects 0.000 claims description 6
- 230000003044 adaptive effect Effects 0.000 claims description 4
- 230000008021 deposition Effects 0.000 claims description 3
- 238000005259 measurement Methods 0.000 claims description 3
- OIGNJSKKLXVSLS-VWUMJDOOSA-N prednisolone Chemical compound O=C1C=C[C@]2(C)[C@H]3[C@@H](O)C[C@](C)([C@@](CC4)(O)C(=O)CO)[C@@H]4[C@@H]3CCC2=C1 OIGNJSKKLXVSLS-VWUMJDOOSA-N 0.000 claims description 3
- 238000009727 automated fiber placement Methods 0.000 claims 4
- 238000010586 diagram Methods 0.000 description 9
- 238000005516 engineering process Methods 0.000 description 8
- 239000011159 matrix material Substances 0.000 description 7
- 230000007480 spreading Effects 0.000 description 3
- 238000003892 spreading Methods 0.000 description 3
- 238000011217 control strategy Methods 0.000 description 2
- 238000013461 design Methods 0.000 description 2
- 238000002844 melting Methods 0.000 description 2
- 230000008018 melting Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 239000011347 resin Substances 0.000 description 2
- 229920005989 resin Polymers 0.000 description 2
- 229920001169 thermoplastic Polymers 0.000 description 2
- 239000004416 thermosoftening plastic Substances 0.000 description 2
- 239000013598 vector Substances 0.000 description 2
- 229920000049 Carbon (fiber) Polymers 0.000 description 1
- 230000002159 abnormal effect Effects 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 238000013528 artificial neural network Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 239000004917 carbon fiber Substances 0.000 description 1
- 238000005056 compaction Methods 0.000 description 1
- 238000005260 corrosion Methods 0.000 description 1
- 230000007797 corrosion Effects 0.000 description 1
- 238000005520 cutting process Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 239000003733 fiber-reinforced composite Substances 0.000 description 1
- 230000009477 glass transition Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- VNWKTOKETHGBQD-UHFFFAOYSA-N methane Chemical compound C VNWKTOKETHGBQD-UHFFFAOYSA-N 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000000465 moulding Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 239000000126 substance Substances 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
- 230000001131 transforming effect Effects 0.000 description 1
- 238000004017 vitrification Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B29—WORKING OF PLASTICS; WORKING OF SUBSTANCES IN A PLASTIC STATE IN GENERAL
- B29C—SHAPING OR JOINING OF PLASTICS; SHAPING OF MATERIAL IN A PLASTIC STATE, NOT OTHERWISE PROVIDED FOR; AFTER-TREATMENT OF THE SHAPED PRODUCTS, e.g. REPAIRING
- B29C70/00—Shaping composites, i.e. plastics material comprising reinforcements, fillers or preformed parts, e.g. inserts
- B29C70/04—Shaping composites, i.e. plastics material comprising reinforcements, fillers or preformed parts, e.g. inserts comprising reinforcements only, e.g. self-reinforcing plastics
- B29C70/28—Shaping operations therefor
- B29C70/30—Shaping by lay-up, i.e. applying fibres, tape or broadsheet on a mould, former or core; Shaping by spray-up, i.e. spraying of fibres on a mould, former or core
- B29C70/38—Automated lay-up, e.g. using robots, laying filaments according to predetermined patterns
- B29C70/382—Automated fiber placement [AFP]
- B29C70/384—Fiber placement heads, e.g. component parts, details or accessories
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B29—WORKING OF PLASTICS; WORKING OF SUBSTANCES IN A PLASTIC STATE IN GENERAL
- B29C—SHAPING OR JOINING OF PLASTICS; SHAPING OF MATERIAL IN A PLASTIC STATE, NOT OTHERWISE PROVIDED FOR; AFTER-TREATMENT OF THE SHAPED PRODUCTS, e.g. REPAIRING
- B29C70/00—Shaping composites, i.e. plastics material comprising reinforcements, fillers or preformed parts, e.g. inserts
- B29C70/04—Shaping composites, i.e. plastics material comprising reinforcements, fillers or preformed parts, e.g. inserts comprising reinforcements only, e.g. self-reinforcing plastics
- B29C70/28—Shaping operations therefor
- B29C70/54—Component parts, details or accessories; Auxiliary operations, e.g. feeding or storage of prepregs or SMC after impregnation or during ageing
Landscapes
- Engineering & Computer Science (AREA)
- Chemical & Material Sciences (AREA)
- Composite Materials (AREA)
- Mechanical Engineering (AREA)
- Robotics (AREA)
- Moulding By Coating Moulds (AREA)
Abstract
本发明公开了一种纤维自动铺放系统,包括纤维自动铺放装置、与纤维自动铺放装置对应设置的模具承载装置以及控制子系统,所述控制子系统包括用于对纤维自动铺放装置进行控制的压辊压力‑铺放轨迹混合控制模块和铺放张力‑速度解耦控制模块以及对模具承载装置的温度进行控制的温度模糊自适应控制模块;本发明还提供了上述的纤维自动铺放装置的铺放轨迹的规划方法。本发明可实现铺放工艺参数的精密控制,从而提高铺放质量,本发明的铺放轨迹能够使协作机械臂避开奇异位姿,同时改善协作机械臂关节受力情况,避免干涉,提高运动效率和安全性。
Description
技术领域
本发明涉及复合材料铺放的技术领域。更具体地说,本发明涉及一种纤维自动铺放系统以及其铺放轨迹的规划方法。
背景技术
碳纤维复合材料具有比强度大、比模量高、抗疲劳和耐化学腐蚀等优良性能,被广泛的应用在航空航天,汽车船舶和体育器材等领域。自动铺放技术是实现复合材料成型的重要方法之一。根据纤维增强复合材料形态,自动铺放技术可分为自动铺带与自动铺丝两类。自动铺丝技术综合了自动铺带和纤维缠绕技术的优点,铺丝头把缠绕技术中多条预浸丝束独立输送和自动铺带技术的压实、切割、重送功能结合在一起,由铺丝头将多根预浸丝束在铺放压辊下集束成为一条宽度可变的预浸带后铺放在模具表面,并压实成型。自动铺丝设备包括自动铺丝头和控制其运动的机床或多自由度机械臂。随着工业机器人技术不断成熟和铺丝设备应用场合多样化的发展,以工业机器人作为运动平台,并与自动铺丝头组合的自动铺丝设备应运而生。
目前国内外对自动铺放系统及其控制方面研究较多,机器人式自动铺丝机的设计主要集中在可以完成自动铺丝的铺放要求,少有铺放压力/位置混合控制研究,也未研究参数耦合(如:张力-速度耦合)对控制效果的影响。综上所述,考虑实际作业过程中外界扰动、负载变化等未知因素以及张力-速度对纤维自动铺放系统的控制影响,对实现异形件的纤维铺放加工具有重要意义。
发明内容
为了实现上述目的,本发明提供一种纤维自动铺放系统,该自动铺放设备考虑了实际作业过程中负载变化等外界扰动,以及张力-速度耦合等的影响进行微调节,提高了纤维的铺放质量。
本发明采用如下的技术方案来实现的:
一种纤维自动铺放系统,包括纤维自动铺放装置、与纤维自动铺放装置对应设置的模具承载装置以及控制子系统,所述控制子系统包括用于对纤维自动铺放装置进行控制的压辊压力-铺放轨迹混合控制模块和铺放张力-速度解耦控制模块以及对模具承载装置的温度进行控制的温度模糊自适应控制模块。
进一步地,所述纤维自动铺放装置包括协作机械臂以及设置在协作机械臂上且用于铺放纤维的铺放头。
进一步地,所述模具承载装置包括多自由度运动平台以及设置在所述多自由度运动平台上的智能温控模具,所述智能温控模具中设置有加热装置。
进一步地,所述压辊压力-铺放轨迹混合控制模块包括位置干扰观测器、位置滑模控制器、压力干扰观测器以及力控制器;
所述压辊压力-铺放轨迹混合控制模块设置为:获取纤维自动铺放装置各轴的实时角度反馈qe,再经正运动学解算后得到实时位置pe,将实时位置pe输入到位置干扰观测器得到位置干扰估计值dp,est,再对得到的实时位置pe进行计算得到位置误差Δxd,将位置误差Δxd输入滑模控制器得到位置输出信号xp;
获取纤维自动铺放装置各轴的力反馈经滤波后的压力值Fe,对该压力值Fe进行计算后得到压力误差ΔFd,将压力误差ΔFd输入到力控制器得到压力输出信号xf,同时将压力值Fe输入到压力干扰观测器得到压力干扰估计值df,est;
将上述得到的位置输出信号xp、压力输出信号xf、位置干扰估计值的相反数-dp,est以及压力干扰估计值的相反数-df,est相加得到纤维自动铺放装置的位置控制量Pa,再经计算后得到纤维自动铺放装置各轴的转角q,根据获得的纤维自动铺放装置各轴的转角q控制纤维自动铺放装置各轴的运动。
进一步地,所述铺放张力-速度解耦控制模块包括解耦控制器、速度PI控制器以及张力PI控制器;
所述铺放张力-速度解耦控制模块设置为:获取纤维自动铺放装置中用于描述张力-速度动态耦合关系的动力学模型,再获取纤维自动铺放装置的实时铺放速度V和铺放张力F,对铺放速度V进行计算得到速度误差ev,对铺放张力F进行计算得到张力误差eF,再将速度误差ev输入到速度控制器中进行计算得到中间输入信号z1,同时将张力误差eF输入到张力控制器中得到中间输入信号z2,然后解耦控制器对中间输入信号z1、z2进行解耦得到纤维自动铺放装置内的放、收卷电机的转矩u1、u2,最后根据得到的放、收卷电机的转矩u1、u2对纤维铺放装置中的放、收卷电机的张力和速度进行控制。
进一步地,所述温度模糊自适应控制模块包括测量变送器、模糊控制器以及PID控制器;
所述温度模糊自适应控制模块设置为:测量变送器获取模具承载装置的实时温度T,对实时温度T进行相关的计算得到温度误差E,将温度误差E和误差变化率EC=dE/dt输入到模糊控制器中得到PID控制器的参数Kp,Ki,Kd,PID控制器根据得到的参数Kp,Ki,Kd计算并输出温度控制量并将温度控制量传递给模具承载装置并控制模具承载装置根据接收到的温度控制量调节自身的加热温度。
本发明的另一个目的是提供一种上述的纤维自动铺放系统的铺放轨迹的规划方法,包括如下步骤:
S1:在进行轨迹规划时先固定模具承载装置,按照复合材料的铺放路径规划出协作机械臂的初始运动轨迹Tr0(t);
S2:对初始运动轨迹进行仿真,固定多模具承载装置,得到协作机械臂在铺放过程中可能出现的奇异位姿、走线/管道缠绕以及运动干涉的时刻tinf,i和此刻的协作机械臂位姿pr(tinf,i);
S3:根据规划的初始运动轨迹Tr0(t)得到在tinf,i-Δt0时刻协作机械臂的位姿pr(tinf,i-Δt0),从此位姿开始,固定协作机械臂不动,对模具承载装置进行从位姿pm(tinf,i-Δt0)到pm(tinf,i)的轨迹规划;
S4:之后再对协作机械臂进行轨迹规划,直到下一个奇异位姿、走线/管道缠绕以及运动干涉的时刻tinf,i+1;
S5:重复S3,S4的循环直到完成全部轨迹规划;
S6:重复S2到S5的循环,消除运动过程中的全部奇异位姿、走线/管道缠绕以及运动干涉的位置,得到协作机械臂轨迹Tr1(t)。
进一步地,还包括如下步骤:
S7:以上述获得的轨迹Tr1(t)为基础,结合铺放压力的大小和方向进行逆运动学求解,得到协作机械臂中各关节的关节力矩T1 n(t),n为各关节的轴的编号,取正整数;
S8:根据T1 n(t)得到所有力矩峰值T1 n(tmax,i),并进行降序排列,选出其中较大的10%力矩峰值和对应的时刻tmax,i;
S9:根据规划的轨迹Tr1(t)得到在tmax,i-Δt1时刻协作机械臂的位姿pr(tmax,i-Δt1),在时间区间(tmax,i-Δt1,tmax,i+Δt1)内,以不存在奇异位姿、走线/管道缠绕以及运动干涉为约束条件,以模具承载装置的各自由度为优化变量,以力矩峰值最小为优化目标进行寻优计算,得到时间区间(tmax,i-Δt1,tmax,i+Δt1)内协作机械臂的运动轨迹;
S10:将各时间区间(tmax,i-Δt1,tmax,i+Δt1)内协作机械臂的运动轨迹与余下时间内协作机械臂的运动轨迹合并得到最终的轨迹Tr2(t)。
本发明至少包括以下有益效果:本发明的压辊压力-铺放轨迹(力/位)混合控制模块针对协作机械臂在铺放方向位置跟踪和力跟踪过程中,考虑实际作业过程中负载变化等外界扰动进行控制,而铺放张力-速度解耦控制模块考虑铺放张力和速度的耦合关系对铺放张力与速度进行实时精密控制,温度模糊自适应控制模块则是针对所采用热塑性复合材料中树脂特性(熔化温度、玻璃化温度),对铺放过程中智能温控模具的加热温度进行模糊自适应控制,使铺放温度处于合适的范围,本发明从三个方面对铺放进行控制,克服了铺放过程中可能存在的铺放偏差,从而大大提高了铺放质量;此外,本发明还提供了纤维自动铺放系统铺放轨迹的规划方法,根据该规划方法规划出的轨迹能使协作机械臂避开奇异位姿且避免走线/管道缠绕以及运动干涉,而且还能克服铺放过程中协作机械臂受力不佳而导致的铺放质量问题,提高运动效率和安全性。
本发明的其它优点、目标和特征将部分通过下面的说明体现,部分还将通过对本发明的研究和实践而为本领域的技术人员所理解。
附图说明
图1为本发明实施例纤维自动铺放系统的结构示意图;
图2为本发明实施例压辊压力-铺放轨迹混合控制模块控制策略图;
图3为本发明实施例的压力干扰观测器框图;
图4为本发明实施例铺放张力-速度解耦控制模块控制策略图;
图5为本发明实施例温度模糊自适应控制模块控制策略图。
具体实施方式
下面结合附图对本发明做进一步的详细说明,以令本领域技术人员参照说明书文字能够据以实施。
本发明提供一种纤维自动铺放装置,如图1所示,包括基于协作机械臂的纤维自动铺放装置1、基于多自由度运动平台的模具承载装置2以及用于对纤维自动铺放装置1和模具承载平台2进行控制的控制子系统。其中,纤维自动铺放装置1包括协作机械臂1-1以及设置在协作机械臂1-1端的铺放头1-2。模具承载装置2包括多自由度运动平台2-1以及设置在多自由度运动平台2-1上的智能温控模具2-2,其中,铺放头1-2与智能温控模具2-2对应设置。为了便于控制铺放温度,智能温控模具2-2内设置有加热装置。上述多自由度运动平台2-1能够实时调整智能温控模具2-2的位姿,使铺放头1-2在模具坐标系下按照确定的轨迹运动时,协作机械臂1-1能够避开奇异位姿,避免走线/管道缠绕以及运动干涉,同时改善协作机械臂1-1关节受力情况,提高运动效率和安全性。
控制子系统包括用于对协作机械臂1-1进行控制的压辊压力-铺放轨迹(力/位)混合控制模块、对铺放头1-2进行控制的铺放张力-速度解耦控制模块以及智能温控模具2-2进行温度控制的温度模糊自适应控制模块。
进一步地,压辊压力-铺放轨迹(力/位)混合控制模块针对协作机械臂1-1在铺放方向位置跟踪和力跟踪过程中,考虑实际作业过程中负载变化等外界扰动进行控制。压辊压力-铺放轨迹(力/位)混合控制模块具体的控制框架图如图2所示,其中,压辊压力-铺放轨迹(力/位)混合控制模块包括位置干扰观测器、位置滑模控制器、压力干扰观测器以及力控制器。
压辊压力-铺放轨迹(力/位)混合控制模块设置为:获取协作机械臂1-1各轴的实时角度反馈qe经正运动学解算后得到实时位置pe,将pe输入到位置干扰观测器中得到位置干扰估计值dp,est,实时位置pe与位置参考作差再经选择矩阵S得到位置误差Δxd,将位置误差Δxd输入滑模控制器中得到输出信号xp;
获取协作机械臂1-1各轴的力反馈经滤波后的压力值Fe与压力参考值作差并经过选择矩阵I-S后得到压力误差ΔFd,将压力误差ΔFd输入到力控制器得到输出信号xf;同时将压力值Fe输入到压力干扰观测器得到压力干扰估计值df,est;最后将位置输出信号xp、压力输出信号xf、位置干扰估计值的相反数-dp,est以及压力干扰估计值的相反数-df,est相加得到协作机械臂1-1的位置控制量Pd,再经逆运动学后得到协作机械臂1-1各轴的转角q,最后根据得到的各轴的转角q控制协作机械臂1-1各轴做相应的运动。
对于其中的滑模位置控制器,采用如下的滑模趋近律
这里,
其中,sigmoid(s)为S型函数,k>0,δ>0,0<α<1,ζ>0均为滑模趋近律参数,Δxd是位置误差,a0为参数,取正常数。
采用如下的终端滑模面
其中,为非线性干扰观测器的估计干扰,Q(x1,x2)为非线性干扰观测器增益矩阵,x1=q为关节角位移矩阵,为关节角速度矩阵,M0为名义惯性矩阵,C0为名义离心力和哥氏力矢量,G0为名义重力矢量,τ为关节驱动力矩。
对于压力干扰,扰动观测器如图3所示,Q(s)为低通滤波器,Gp -1(s)为被控对象模型的逆,Gp(s)是被控对象的传递函数,u是输入信号,df是压力扰动,df,est是压力扰动估计值,ε是误差项,y是输出信号。那么有
df,est=(ε+df)Gp(s)Gp -1(s)-ε=df (6)
即得到了压力扰动df的估计值df,est。
铺放张力-速度解耦控制模块考虑铺放张力和速度的耦合关系,采用基于模型的方法设计解耦控制器,输出铺放头1-2内放、收卷电机的控制量,实现对张力和速度的解耦。针对解耦后的系统进行跟踪控制器的设计,从而实现铺放张力与铺放速度的解耦控制。该铺放张力-速度解耦控制模块包括解耦控制器、速度控制器以及张力控制器。铺放张力-速度解耦控制模块设置为:获取铺放头1-2用于描述张力-速度动态耦合关系的动力学模型,再获取铺放头1-2的实时铺放速度V和铺放张力F,对铺放速度V进行计算得到速度误差ev,对铺放张力F进行计算得到张力误差eF,再将ev输入到速度控制器中进行计算得到中间输入信号z1,同时将eF输入到张力控制器中得到中间输入信号z2,然后解耦控制器对中间输入信号z1、z2进行解耦后得到铺放头1-2内的放、收卷电机的转矩u1、u2,最后根据得到的放、收卷电机的转矩u1、u2对铺放头内的放、收卷电机的张力和速度进行控制。该铺放张力-速度解耦控制模块利用张力、速度信息与传感器系统反馈信息作为输入,实现铺放张力与速度的实时精密控制,进而提高铺放质量。
具体的控制框架图如图4所示。图中,V和F分别为速度与张力,eV和eF分别为速度和张力误差,z1和z2分别为速度和张力控制器输出的中间变量,u1=M1和u2=M2分别为放、收卷电机的转矩。
首先建立铺放头的动力学模型来描述其张力-速度动态耦合关系,即
其中,v为输带速度,F2为收卷侧张力,M1,M2分别为放、收卷电机的转矩,B(x),C(x),D(x),E(x),F(x),G(x)为与铺放头结构尺寸有关的量。
将(8)式变形可得
其中,z1,z2为中间变量。
系统参考输入为速度和张力,系统模型的输出分别与参考输入做差得到速度误差ev和张力误差eF,ev和eF通过张力PI控制器和速度PI控制器得到两个中间输入信号z1、z2,z1、z2经过解耦控制器后得到系统模型的两个输入u1、u2,PI控制律如下:
其中kP1、kI1、kP2、kI2为PI控制参数,s为复参变量。
温度模糊自适应控制模块针对所采用热塑性复合材料中树脂特性(熔化温度、玻璃化温度),对铺放过程中智能温控模具的加热温度进行模糊自适应控制,使铺放温度处于合适的范围。温度模糊自适应控制模块包括测量变送器、模糊控制器以及PID控制器,其具体的控制框架图如图5所示。图5中,测量变送器获取智能温控加热模具2-2中的加热装置的实时温度T,再将实时温度T与参考温度-ΔT相加得到温度误差E,将温度误差E和误差变化率EC=dE/dt输入模糊控制器得到PID控制器的参数Kp,Ki,Kd,PID控制器根据得到的参数Kp,Ki,Kd计算并输出温度控制量并将温度控制量传递给智能温控模具2-2中的加热装置并控制加热装置根据接收到的温度控制量调节自身的加热温度。
本发明的另一个目的是提供一种纤维自动铺放系统铺放轨迹的规划方法,采用该铺放轨迹能够使协作机械臂避开奇异位姿且避免走线/管道缠绕以及运动干涉,包括如下步骤:
S1:在进行轨迹规划时先固定多自由度运动平台2-1,按照复合材料的铺放路径规划出协作机械臂1-2的初始运动轨迹Tr0(t);
S2:在Adams等动力学仿真软件中进行运动轨迹仿真,固定多自由度运动平台2-1,得到协作机械臂1-1在铺放过程中可能出现的奇异位姿、走线/管道缠绕以及运动干涉的时刻tinf,i和此刻的协作机械臂1-1位姿pr(tinf,i);
S3:根据规划的初始运动轨迹Tr0(t)得到在tinf,i-Δt0时刻协作机械臂1-1的位姿pr(tinf,i-Δt0),从此位姿开始,固定协作机械1-1不动,对多自由度运动平台2-1进行从位姿pm(tinf,i-Δt0)到pm(tinf,i)的轨迹规划;
S4:之后再对协作机械臂1-1进行轨迹规划,直到下一个奇异位姿、走线/管道缠绕以及运动干涉的时刻tinf,i+1;
S5:重复S3,S4的循环直到完成全部轨迹规划;
S6:重复S2到S5的循环,消除运动过程中的全部奇异位姿、走线/管道缠绕以及运动干涉的位置,得到轨迹Tr1(t)。
为了进一步克服铺放过程中协作机械臂因受力不佳而导致的铺放偏差,纤维自动铺放系统铺放轨迹的规划方法还包括如下步骤:
S7:以上述得到的轨迹Tr1(t)为基础,结合铺放压力的大小和方向进行逆运动学求解,得到协作机械臂1-1各关节的关节力矩T1 n(t),这里n为各关节的轴的编号,取正整数;
S8:根据T1 n(t)得到所有力矩峰值T1 n(tmax,i),并进行降序排列,选出其中较大的10%力矩峰值和对应的时刻tmax,i;
S9:根据规划的轨迹Tr1(t)得到在tmax,i-Δt1时刻协作机械臂1-1的pr(tmax,i-Δt1),在时间区间(tmax,i-Δt1,tmax,i+Δt1)内,以不存在奇异位姿、走线/管道缠绕以及运动干涉为约束条件,以多自由度平台的各自由度为优化变量,以力矩峰值最小为优化目标,采用神经网络等方法进行寻优,得到时间区间(tmax,i-Δt1,tmax,i+Δt1)内协作机械臂1-1的运动轨迹;
S10:将各时间区间(tmax,i-Δt1,tmax,i+Δt1)内协作机械臂1-1的运动轨迹与余下时间内协作机械臂1-1的运动轨迹合并得到轨迹Tr2(t)。
尽管本发明的实施方案已公开如上,但其并不仅仅限于说明书和实施方式中所列运用,它完全可以被适用于各种适合本发明的领域,对于熟悉本领域的人员而言,可容易地实现另外的修改,因此在不背离权利要求及等同范围所限定的一般概念下,本发明并不限于特定的细节和这里示出与描述的图例。
Claims (6)
1.一种纤维自动铺放系统的铺放轨迹的规划方法,其特征在于,所述纤维自动铺放系统包括纤维自动铺放装置、与纤维自动铺放装置对应设置的模具承载装置以及控制子系统,所述控制子系统包括用于对纤维自动铺放装置进行控制的压辊压力-铺放轨迹混合控制模块和铺放张力-速度解耦控制模块以及对模具承载装置的温度进行控制的温度模糊自适应控制模块,其中,所述纤维自动铺放装置包括协作机械臂以及设置在协作机械臂上且用于铺放纤维的铺放头;
纤维自动铺放系统的铺放轨迹的规划方法包括如下步骤:
S1:在进行轨迹规划时先固定模具承载装置,按照复合材料的铺放路径规划出协作机械臂的初始运动轨迹Tr0(t);
S2:对初始运动轨迹进行仿真,固定多模具承载装置,得到协作机械臂在铺放过程中可能出现的奇异位姿、走线/管道缠绕以及运动干涉的时刻tinf,i和此刻的协作机械臂位姿pr(tinf,i);
S3:根据规划的初始运动轨迹Tr0(t)得到在tinf,i-Δt0时刻协作机械臂的位姿pr(tinf,i-Δt0),从此位姿开始,固定协作机械臂不动,对模具承载装置进行从位姿pm(tinf,i-Δt0)到pm(tinf,i)的轨迹规划;
S4:之后再对协作机械臂进行轨迹规划,直到下一个奇异位姿、走线/管道缠绕以及运动干涉的时刻tinf,i+1;
S5:重复S3,S4的循环直到完成全部轨迹规划;
S6:重复S2到S5的循环,消除运动过程中的全部奇异位姿、走线/管道缠绕以及运动干涉的位置,得到协作机械臂轨迹Tr1(t)。
2.如权利要求1所述的纤维自动铺放系统的铺放轨迹的规划方法,其特征在于,所述模具承载装置包括多自由度运动平台以及设置在所述多自由度运动平台上的智能温控模具,所述智能温控模具中设置有加热装置。
3.如权利要求1所述的纤维自动铺放系统的铺放轨迹的规划方法,其特征在于,所述压辊压力-铺放轨迹混合控制模块包括位置干扰观测器、位置滑模控制器、压力干扰观测器以及力控制器;
所述压辊压力-铺放轨迹混合控制模块设置为:获取纤维自动铺放装置各轴的实时角度反馈qe,再经正运动学解算后得到实时位置pe,将实时位置pe输入到位置干扰观测器得到位置干扰估计值dp,est,再对得到的实时位置pe进行计算得到位置误差Δxd,将位置误差Δxd输入滑模控制器得到位置输出信号xp;
获取纤维自动铺放装置各轴的力反馈经滤波后的压力值Fe,对该压力值Fe进行计算后得到力误差ΔFd,将压力误差ΔFd输入到力控制器得到压力输出信号xf,同时将压力值Fe输入到压力干扰观测器得到压力干扰估计值df,est;
将上述得到的位置输出信号xp、压力输出信号xf、位置干扰估计值的相反数-dp,est以及压力干扰估计值的相反数-df,est相加得到纤维自动铺放装置的位置控制量Pa,再经计算后得到纤维自动铺放装置各轴的转角q,根据获得的纤维自动铺放装置各轴的转角q控制机械臂各轴的运动。
4.如权利要求1所述的纤维自动铺放系统的铺放轨迹的规划方法,其特征在于,所述铺放张力-速度解耦控制模块包括解耦控制器、速度PI控制器以及张力PI控制器;
所述铺放张力-速度解耦控制模块设置为:获取纤维自动铺放装置中用于描述张力-速度动态耦合关系的动力学模型,再获取纤维自动铺放装置的实时铺放速度V和铺放张力F,对铺放速度V进行计算得到速度误差ev,对送料张力F进行计算得到张力误差eF,再将速度误差ev输入到速度PI控制器中进行计算得到中间输入信号z1,同时将张力误差eF输入到张力PI控制器中得到中间输入信号z2,然后解耦控制器对中间输入信号z1、z2进行解耦得到纤维自动铺放装置内的放、收卷电机的转矩u1、u2,最后根据得到的放、收卷电机的转矩u1、u2对纤维铺放装置中的放、收卷电机的张力和速度进行控制。
5.如权利要求1所述的纤维自动铺放系统的铺放轨迹的规划方法,其特征在于,所述温度模糊自适应控制模块包括测量变送器、模糊控制器以及PID控制器;
所述温度模糊自适应控制模块设置为:测量变送器获取模具承载装置的实时温度T,对实时温度T进行相关的计算得到温度误差E,将温度误差E和误差变化率EC=dE/dt输入到模糊控制器中得到PID控制器的参数Kp,Ki,Kd,PID控制器根据得到的参数Kp,Ki,Kd计算并输出温度控制量并将温度控制量传递给模具承载装置并控制模具承载装置根据接收到的温度控制量调节自身的加热温度。
6.如权利要求1所述的纤维自动铺放系统的铺放轨迹的规划方法,其特征在于,还包括如下步骤:
S7:以上述获得的协作机械臂的轨迹Tr1(t)为基础,结合铺放压力的大小和方向进行逆运动学求解,得到协作机械臂中各关节的关节力矩T1 n(t),n为各关节的轴的编号,取正整数;
S8:根据T1 n(t)得到所有力矩峰值T1 n(tmax,i),并进行降序排列,选出其中较大的10%力矩峰值和对应的时刻tmax,i;
S9:根据规划的轨迹Tr1(t)得到在tmax,i-Δt1时刻协作机械臂的pr(tmax,i-Δt1),在时间区间(tmax,i-Δt1,tmax,i+Δt1)内,以不存在奇异位姿、走线/管道缠绕以及运动干涉为约束条件,以模具承载装置的各自由度为优化变量,以力矩峰值最小为优化目标进行寻优计算,得到时间区间(tmax,i-Δt1,tmax,i+Δt1)内协作机械臂的运动轨迹;
S10:将各时间区间(tmax,i-Δt1,tmax,i+Δt1)内协作机械臂的运动轨迹与余下时间内协作机械臂的运动轨迹合并得到最终的轨迹Tr2(t)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010934994.XA CN112223788B (zh) | 2020-09-08 | 2020-09-08 | 纤维自动铺放系统以及其铺放轨迹的规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010934994.XA CN112223788B (zh) | 2020-09-08 | 2020-09-08 | 纤维自动铺放系统以及其铺放轨迹的规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112223788A CN112223788A (zh) | 2021-01-15 |
CN112223788B true CN112223788B (zh) | 2022-02-01 |
Family
ID=74116753
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010934994.XA Active CN112223788B (zh) | 2020-09-08 | 2020-09-08 | 纤维自动铺放系统以及其铺放轨迹的规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112223788B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113985809A (zh) * | 2021-10-17 | 2022-01-28 | 哈尔滨理工大学 | 一种干纤维压力容器机器人缠绕工作站控制系统 |
CN114488814B (zh) * | 2022-01-26 | 2023-05-30 | 中国航空制造技术研究院 | 一种消除重力扰动高精度铺放张力控制方法 |
CN114670468B (zh) * | 2022-03-18 | 2023-11-03 | 中国航空制造技术研究院 | 一种基于贴膜面和压辊性能的丝束铺放参数调整方法 |
CN117775886B (zh) * | 2024-02-26 | 2024-05-10 | 太原理工大学 | 一种用于纤维缠绕的高性能张力控制方法及系统 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0535264A1 (en) * | 1991-09-30 | 1993-04-07 | Cincinnati Milacron Inc. | Fibre placement apparatus, and method of maintaining alignment |
CN101254652A (zh) * | 2007-12-28 | 2008-09-03 | 西安交通大学 | 制造树脂基复合材料构件的原位固结纤维铺放方法及装置 |
CN101419446A (zh) * | 2008-11-26 | 2009-04-29 | 南京航空航天大学 | 复合材料铺放轨迹微变径自调整方法 |
CN104354302A (zh) * | 2014-10-29 | 2015-02-18 | 西安交通大学 | 一种自动化贴膜式铺放复合材料预成型体的装置及方法 |
CN107330170A (zh) * | 2017-06-16 | 2017-11-07 | 南京航空航天大学 | 基于类回转体构件形心的自动铺丝轨迹切片环生成算法 |
Family Cites Families (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4860215A (en) * | 1987-04-06 | 1989-08-22 | California Institute Of Technology | Method and apparatus for adaptive force and position control of manipulators |
DE68923889T2 (de) * | 1988-03-01 | 1996-01-18 | Hitachi Construction Machinery | Positions-/Kraft-Steuerungsgerät für Werkzeugmaschinen mit mehreren Freiheitsgraden. |
JP3937108B2 (ja) * | 1997-07-18 | 2007-06-27 | 株式会社安川電機 | ロボットの制御方法およびロボット |
CN102380956B (zh) * | 2011-08-26 | 2014-05-14 | 武汉理工大学 | 热熔法制备纤维预浸丝的方法及其设备 |
CN104626152B (zh) * | 2013-11-14 | 2016-08-31 | 沈阳新松机器人自动化股份有限公司 | 工业机器人主动柔顺控制方法及装置 |
CN104570955B (zh) * | 2014-11-24 | 2018-06-22 | 中国科学院自动化研究所 | 一种复合材料自动铺丝机控制系统及控制方法 |
CN104484516A (zh) * | 2014-12-04 | 2015-04-01 | 江苏恒神纤维材料有限公司 | 轨迹规划软件辅助铺放预浸料铺层的方法 |
CN205310853U (zh) * | 2015-11-16 | 2016-06-15 | 上海航天设备制造总厂 | 一种曲面自动铺放装置 |
CN106041926B (zh) * | 2016-06-12 | 2018-10-19 | 哈尔滨工程大学 | 一种基于卡尔曼滤波器的工业机械臂力/位置混合控制方法 |
GB2557336A (en) * | 2016-12-07 | 2018-06-20 | Composite Tech And Applications Limited | A method of checking headpath data |
DE102018213416A1 (de) * | 2018-08-09 | 2020-02-13 | Siemens Aktiengesellschaft | Verfahren zur Werkzeugpfadplanung, Computerprogramm sowie elektronisch lesbarer Datenträger |
CN110789155A (zh) * | 2019-11-08 | 2020-02-14 | 江苏科技大学 | 一种海上风电叶片碳纤维自动成型设备及铺放工艺方法 |
CN111360839A (zh) * | 2020-04-24 | 2020-07-03 | 哈尔滨派拉科技有限公司 | 一种基于运动轨迹的多构型机械臂分层级控制方法及系统 |
-
2020
- 2020-09-08 CN CN202010934994.XA patent/CN112223788B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0535264A1 (en) * | 1991-09-30 | 1993-04-07 | Cincinnati Milacron Inc. | Fibre placement apparatus, and method of maintaining alignment |
CN101254652A (zh) * | 2007-12-28 | 2008-09-03 | 西安交通大学 | 制造树脂基复合材料构件的原位固结纤维铺放方法及装置 |
CN101419446A (zh) * | 2008-11-26 | 2009-04-29 | 南京航空航天大学 | 复合材料铺放轨迹微变径自调整方法 |
CN104354302A (zh) * | 2014-10-29 | 2015-02-18 | 西安交通大学 | 一种自动化贴膜式铺放复合材料预成型体的装置及方法 |
CN107330170A (zh) * | 2017-06-16 | 2017-11-07 | 南京航空航天大学 | 基于类回转体构件形心的自动铺丝轨迹切片环生成算法 |
Also Published As
Publication number | Publication date |
---|---|
CN112223788A (zh) | 2021-01-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112223788B (zh) | 纤维自动铺放系统以及其铺放轨迹的规划方法 | |
CN105772917B (zh) | 一种三关节点焊机器人轨迹跟踪控制方法 | |
Corradini et al. | Discrete time sliding mode control of robotic manipulators: Development and experimental validation | |
Yang et al. | Novel approach for adaptive tracking control of a 3-D overhead crane system | |
Zha et al. | A survey of intelligent driving vehicle trajectory tracking based on vehicle dynamics | |
CN110861090B (zh) | 一种力矩前馈控制系统及方法 | |
CN112757306A (zh) | 一种机械臂逆解多解选择和时间最优轨迹规划算法 | |
CN102385342A (zh) | 虚拟轴机床并联机构运动控制的自适应动态滑模控制方法 | |
CN111158349A (zh) | 一种基于多步线性化策略的无人驾驶车辆模型预测控制方法 | |
CN108584700B (zh) | 起重机自适应pid闭环防摇控制方法 | |
CN112091829B (zh) | 一种喷砂除锈并联机器人补偿摩擦力突变模糊自适应滑模控制方法 | |
Zarei et al. | Oscillation damping of nonlinear control systems based on the phase trajectory length concept: An experimental case study on a cable-driven parallel robot | |
CN111687827A (zh) | 一种双机器人协调操作弱刚性构件的控制方法和控制系统 | |
Tajdari et al. | Design, implementation and control of a two-link fully-actuated robot capable of online identification of unknown dynamical parameters using adaptive sliding mode controller | |
CN110968037B (zh) | 一种减小多轴运动系统轮廓误差的控制方法 | |
CN115741681B (zh) | 多轴机械臂关节伺服系统的控制方法及系统 | |
CN116382332A (zh) | 一种基于ude的战斗机大机动鲁棒飞行控制方法 | |
CN116339141A (zh) | 一种机械臂全局固定时间轨迹跟踪滑模控制方法 | |
CN108724195B (zh) | 一种针对机器人的耦合前馈控制方法 | |
CN115107035B (zh) | 一种机器人单关节人工免疫系统监控的混合控制方法 | |
CN116931508A (zh) | 一种基于运动模型的多轴智能伺服驱控一体控制系统 | |
An et al. | Fast model-free learning for controlling a quadrotor UAV with designed error trajectory | |
CN112147894B (zh) | 基于运动学和动力学模型的轮式移动机器人主动控制方法 | |
CN114840947A (zh) | 一种带约束的三自由度机械臂动力学模型 | |
CN115026845B (zh) | 一种机器人单关节混合控制方法 |
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 |