双Y轴齿轮齿条与XZ轴丝杆模组的协同运动控制方法及系统与流程
本技术涉及运动控制,具体而言,涉及双y轴齿轮齿条与xz轴丝杆模组的协同运动控制方法及系统。
背景技术:
1、在大型数控加工设备、精密检测平台以及自动化生产线等应用场景中,常采用跨距较大的龙门式或框架式运动平台,由横梁式的运动模组承载工作部件,并沿两条平行布置的导轨做长行程的往复运动。在此类双端支承的传动结构中,运动模组的两端通常各设置一套齿轮齿条副,由两台电机分别驱动,以实现大跨距条件下的稳定进给。
2、然而,在上述特定场景中面临以下挑战。首先,齿轮与齿条啮合时不可避免存在齿侧间隙,双端驱动时两侧齿轮的间隙状态并不一致,模组在启动、换向或者承受偏载时,轮齿会在齿侧间隙内产生相对窜动,形成空程误差并使模组相对导轨产生扭摆。其次,工作部件在横梁上的位置沿x轴方向不断变化,其重心到两条导轨的水平距离随之改变,两侧齿轮的承载比例始终处于动态变化之中,采用固定比例分配两侧驱动扭矩的方式无法与实际偏载状态相匹配,重载侧出力不足与轻载侧出力过剩的问题较为突出。再次,工作部件还会被z轴丝杆沿竖直方向抬升,重心越高,其重力对两侧齿轮的倾覆作用越明显,上述偏载差异被进一步放大,扭摆与定位误差随之加剧。此外,两条导轨在装配后难以做到理想平行,平行度误差使得两侧齿轮在相同时间内所需滚过的距离并不相等,两侧电机的出力出现持续性不均衡;而齿轮齿条的周期性啮合冲击又容易与横梁上丝杆的固有频率相接近而引发共振,进一步影响工作部件的定位精度与设备的运行平稳性。
技术实现思路
1、本技术的目的在于提供一种双y轴齿轮齿条与xz轴丝杆模组的协同运动控制方法及系统,具有能够根据工作部件的实际位置动态分配两侧齿轮的驱动扭矩、并以方向相反的补偿扭矩在两侧齿条上形成对顶预紧,从而在消除齿侧间隙的同时抑制模组扭摆,提高定位精度与运行平稳性的优点。
2、本技术提供了一种双y轴齿轮齿条与xz轴丝杆模组的协同运动控制方法,所述xz轴丝杆模组跨设于平行的第一y轴导轨与第二y轴导轨之间,所述模组的第一端设有第一齿轮、第二端设有第二齿轮,所述第一齿轮与所述第一y轴导轨上的第一齿条啮合,所述第二齿轮与所述第二y轴导轨上的第二齿条啮合,所述第一齿轮、第二齿轮分别由第一电机、第二电机驱动,所述模组上设有带工作部件的x轴丝杆;所述方法包括:
3、获取所述工作部件的x向位置及所述模组的y轴运动方向;
4、根据所述x向位置确定所述工作部件在所述第一齿轮上的第一负载占比和在第二齿轮上的第二负载占比;
5、根据所述y轴运动方向、所述x向位置及所述第一负载占比、第二负载占比,确定所述第一齿轮的第一补偿扭矩和所述第二齿轮的第二补偿扭矩,所述第一补偿扭矩、第二补偿扭矩方向相反;
6、根据所述第一负载占比、第二负载占比确定第一负载扭矩、第二负载扭矩,将所述第一补偿扭矩、第二补偿扭矩分别叠加至对应负载扭矩得第一输出扭矩、第二输出扭矩;
7、按所述第一输出扭矩、第二输出扭矩分别控制所述第一电机、第二电机,带动所述模组沿y轴方向运动。
8、进一步,所述获取所述工作部件的x向位置,包括:
9、通过装在所述x轴丝杆上的x轴编码器,获取所述x轴丝杆的旋转角度;
10、根据所述旋转角度以及所述x轴丝杆的导程,计算所述工作部件相对于所述x轴丝杆原点的x向位置。
11、进一步,所述xz轴丝杆模组上还设有z轴丝杆;在获取所述工作部件的x向位置之后,还包括:
12、获取所述工作部件在所述z轴丝杆上的z向位置;
13、根据所述z向位置,确定所述工作部件的重心到所述第一齿条和所述第二齿条所在平面的竖直距离,将所述竖直距离作为力臂;
14、根据所述力臂对所述第一负载占比和所述第二负载占比进行修正,使所述第一负载占比与所述第二负载占比之间的差值随所述力臂的增大而增大,且所述差值的增大方向与所述工作部件沿x轴方向靠近所述第一y轴导轨或所述第二y轴导轨的方向一致。
15、进一步,所述根据所述y轴运动方向、所述x向位置及所述第一负载占比、第二负载占比,确定所述第一齿轮的第一补偿扭矩和所述第二齿轮的第二补偿扭矩,包括:
16、根据所述x向位置,确定所述工作部件与所述第一y轴导轨之间的第一水平距离,以及所述工作部件与所述第二y轴导轨之间的第二水平距离;
17、根据所述第一水平距离确定所述第一补偿扭矩的基础值,根据所述第二水平距离确定所述第二补偿扭矩的基础值;所述第一水平距离越小,所述第一补偿扭矩的基础值越小;所述第二水平距离越小,所述第二补偿扭矩的基础值越小。
18、进一步,还包括:根据所述y轴运动方向以及所述第一负载占比和所述第二负载占比,对所述第一补偿扭矩的基础值和所述第二补偿扭矩的基础值进行联动修正:当所述第一负载占比大于所述第二负载占比时,减小所述第一补偿扭矩的基础值并增大所述第二补偿扭矩的基础值,且所述第一补偿扭矩的方向与所述y轴运动方向相同、所述第二补偿扭矩的方向与所述y轴运动方向相反;当所述第二负载占比大于所述第一负载占比时,增大所述第一补偿扭矩的基础值并减小所述第二补偿扭矩的基础值,且所述第一补偿扭矩的方向与所述y轴运动方向相反、所述第二补偿扭矩的方向与所述y轴运动方向相同。
19、进一步,所述根据所述第一负载占比、第二负载占比确定第一负载扭矩、第二负载扭矩,将所述第一补偿扭矩、第二补偿扭矩分别叠加至对应负载扭矩得第一输出扭矩、第二输出扭矩,包括:
20、根据所述工作部件的质量以及所述xz轴丝杆模组沿y轴方向的运动加速度,确定所述工作部件的总负载扭矩;
21、将所述总负载扭矩按所述第一负载占比分配给所述第一齿轮,得到所述第一负载扭矩,并将所述总负载扭矩按所述第二负载占比分配给所述第二齿轮,得到所述第二负载扭矩;
22、将所述第一补偿扭矩与所述第一负载扭矩相加,得到所述第一电机的第一输出扭矩;
23、将所述第二补偿扭矩与所述第二负载扭矩相加,得到所述第二电机的第二输出扭矩。
24、进一步,还包括:通过装在所述第一电机上的第一编码器获取所述第一齿轮的第一转动角度,根据所述第一转动角度与所述第一齿条的齿距,确定所述第一齿轮的轮齿在所述第一齿条相邻两齿之间的第一啮合位置;
25、通过装在所述第二电机上的第二编码器获取所述第二齿轮的第二转动角度,根据所述第二转动角度与所述第二齿条的齿距,确定所述第二齿轮的轮齿在所述第二齿条相邻两齿之间的第二啮合位置;
26、根据所述第一啮合位置与所述第二啮合位置确定啮合位置差;当所述啮合位置差小于预设阈值时,降低所述工作部件沿所述x轴丝杆运动的加速度,并判定所述第一齿轮与所述第二齿轮处于同步啮合状态;所述预设阈值根据所述第一齿条的齿距确定。
27、进一步,按所述第一输出扭矩、第二输出扭矩分别控制所述第一电机、第二电机,带动所述模组沿y轴方向运动时,还包括:
28、获取所述第一电机的第一电流值和所述第二电机的第二电流值;计算所述第一电流值与所述第二电流值之间的电流差值;
29、对所述电流差值进行低通滤波,滤除所述第一齿条和所述第二齿条的齿形误差引起的周期性波动,得到所述第一y轴导轨与所述第二y轴导轨之间平行度误差对应的直流分量;
30、根据所述直流分量调整所述第一输出扭矩或所述第二输出扭矩,使所述第一齿轮和所述第二齿轮沿y轴方向的位移保持一致。
31、进一步,在根据所述直流分量调整所述第一输出扭矩或所述第二输出扭矩时,还包括:获取所述xz轴丝杆模组沿y轴方向的当前运动速度;根据所述当前运动速度与所述第一齿条的齿距,计算所述第一齿轮在所述第一齿条上的啮合频率;获取所述x轴丝杆的固有频率;计算所述啮合频率与所述固有频率之间的频率差值;当所述频率差值小于设定阈值时,降低所述工作部件沿所述x轴丝杆运动的加速度。
32、此外,本技术还提出一种双y轴齿轮齿条与xz轴丝杆模组的协同运动控制系统,包括:
33、平行布置的第一y轴导轨和第二y轴导轨;
34、第一齿条,固定于所述第一y轴导轨;
35、第二齿条,固定于所述第二y轴导轨;
36、xz轴丝杆模组,跨设于所述第一y轴导轨与所述第二y轴导轨之间,所述模组的第一端设有第一齿轮、第二端设有第二齿轮,所述第一齿轮与所述第一齿条啮合,所述第二齿轮与所述第二齿条啮合,所述模组上设有带工作部件的x轴丝杆;
37、x轴编码器,装于所述x轴丝杆,用于检测所述x轴丝杆的旋转角度;
38、第一电机,与所述第一齿轮传动连接;
39、第二电机,与所述第二齿轮传动连接;以及控制器,所述控制器被配置为执行前述的方法。
40、由上可知,本技术提供的一种双y轴齿轮齿条与xz轴丝杆模组的协同运动控制方法及系统,通过根据工作部件的x向位置确定两侧齿轮的负载占比、结合y轴运动方向确定方向相反的两路补偿扭矩、将补偿扭矩叠加至按负载占比分配的负载扭矩得到两侧电机的输出扭矩,并在运行过程中依据两侧电机的电流差值补偿两条导轨之间的平行度误差、在啮合频率接近丝杆固有频率或者两侧齿轮处于同步啮合状态时降低x轴方向的运动加速度,解决了双端齿轮齿条驱动中齿侧间隙引起的空程误差与模组扭摆、偏载状态下两侧驱动扭矩分配失配、以及平行度误差与啮合共振导致的定位精度下降的问题,具有能够根据工作部件的实际位置动态分配两侧驱动扭矩并实现双向消隙,提高大跨距运动平台的定位精度与运行平稳性的优点。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com