CRTS-III型轨道板模具清理装置的四电机驱动同步及消隙控制方法制造方法及图纸

本发明专利技术公开了一种CRTS‑III型轨道板模具清理装置的四电机驱动同步及消隙控制方法，包括以下步骤：构建四电机驱动系统电气连接结构，将四台电机分为两组，其中，每组中的两台电机分别驱动主控轴和被控轴；在插补运算处理阶段，将控制器运动控制中的插补运算分离，以便将插补运算划分为粗插补和精插补两部分；在同步及消隙控制阶段，对于双轴同步控制，采用双轴并行同步控制方法，控制对象为两组轴中的主控轴；以及对于消隙控制，采用双电机驱动消隙控制方法，控制对象为每组电机所驱动的主控轴和被控轴。本发明专利技术的控制方法具有良好的同步效果和消隙效果，同时具有充足的驱动力和灵活开放的控制方式。

【技术实现步骤摘要】
CRTS-III型轨道板模具清理装置的四电机驱动同步及消隙控制方法
本专利技术是关于设备运行控制的数字控制
，特别是关于一种CRTS-III型轨道板模具清理装置的四电机驱动同步及消隙控制方法。
技术介绍
随着我国高铁技术的发展，CRTS-III型轨道板的生产已经由台座法逐步向流水机组法过渡，全面的自动化生产已经得到了应用。在轨道板生产过程中，针对轨道板脱模后模具内有水泥残渣遗留和每次打板前轨道板清洗的需求，现有生产模式需人工清理，时间长而且劳工强度较大且粉尘对人体伤害较大。在智能制造新模式中，模具清理工位由封闭清理室、模具定位系统、多轴桁架机器人系统、末端毛刷清理系统、除尘系统、安全防护报警六系统组成。在生产线上采用智能模具清理机器人，采用智能自动化方式完成模具在生产线的无人清理工作。因为模具清理装置需要较大的力来实现清理功能，一般采用龙门移动平台来实现重载清理装置的平稳运行。目前重载龙门移动平台的传动方式主要有两种：一种是滚珠丝杠传动方式，即采用单台电机加上单个滚珠丝杠传动的单边驱动形式或者双电机加上双滚珠丝杠的双边驱动形式。其中单轴单边驱动很难将驱动力龙门移动平台的重心，其产生的不对称的驱动力会造成丝杠的弯曲变形而影响系统的定位精度。另一种传动方式是齿轮齿条传动方式。在该传动方式下，齿条位于工作台两侧对称放置，电机通过驱动两边的齿轮共同驱动工作台的运动。若采用双电机驱动，即每侧紧使用一台电机驱动齿轮，系统在换向时，由于齿轮与齿条之间存在齿轮的侧向间隙，会使进给运动反向滞后，从而影响传动精度。若采用四台电机驱动，即每侧使用两台电机驱动两个齿轮同时与齿条啮合传动，若能使两齿轮的轮齿分别与齿条轮齿的相反两侧相接触，则可消除反向传动侧隙。因此如何在确保消除齿轮与齿条之间齿侧间隙的同时，并使重载龙门移动平台两侧的位移量保持同步，是需要解决的关键问题。公开于该
技术介绍
部分的信息仅仅旨在增加对本专利技术的总体背景的理解，而不应当被视为承认或以任何形式暗示该信息构成已为本领域一般技术人员所公知的现有技术。
技术实现思路
本专利技术的目的在于提供一种CRTS-III型轨道板模具清理装置的四电机驱动同步及消隙控制方法，其能够克服现有技术的上述缺点。为实现上述目的，本专利技术提供了一种CRTS-III型轨道板模具清理装置的四电机驱动同步及消隙控制方法，包括以下步骤：构建四电机驱动系统电气连接结构，将四台电机分为两组，其中，每组中的两台电机分别驱动主控轴和被控轴；在插补运算处理阶段，将控制器运动控制中的插补运算分离，以便将插补运算划分为粗插补和精插补两部分；在同步及消隙控制阶段，对于双轴同步控制，采用双轴并行同步控制方法，控制对象为两组轴中的主控轴；以及对于消隙控制，采用双电机驱动消隙控制方法，控制对象为每组电机所驱动的主控轴和被控轴。在一优选的实施方式中，电气连接结构采用实时以太网总线以菊花链的形式将设备控制器与四套伺服驱动器和电机连接在一起，并将四套伺服驱动器和电机划分为第一组伺服驱动器和电机和第二组伺服驱动器和电机，其中，位于龙门移动平台同侧的两套伺服驱动器和电机被划分为同一组。在一优选的实施方式中，粗插补的插补周期与原开放式设备控制器的插补周期保持一致。在一优选的实施方式中，精插补的插补周期被设置为粗插补的插补周期的1/n，以匹配伺服驱动器的控制周期，提高控制频率。在一优选的实施方式中，双轴并行同步控制方法具体为：依据两个主控轴的反馈位置计算各自的位置跟随误差以及两个主控轴之间的位置同步误差；将位置同步误差作为输入量输入到双轴并行同步控制器中，控制器经过运算得到补偿量；将位置跟随误差作为补偿量分配的依据，计算两个主控轴的补偿分量；最后通过实时以太网总线将计算得到的补偿分量分配到相应的主控轴中。在一优选的实施方式中，双轴并行同步控制器采用分区域的PID控制算法。在一优选的实施方式中，双电机驱动消隙控制方法具体为：针对每组内的主控轴和被控轴，采用齿轮齿条传动控制器，以使主控轴和被控轴均输出相同的扭矩；依据各组消隙卡中监测到的电机电流计算各个组内主控轴和被控轴之间需要施加的偏置力矩；将偏置力矩通过实时以太网总线传送到消隙卡中。在一优选的实施方式中，齿轮齿条传动控制器是用于控制齿轮齿条传动机构或者行星齿轮传动机构的双电机驱动控制器，齿轮齿条传动控制器在两个电机之间施加一个大小相等方向相反的预紧力，以消除齿轮在启动或是换向时产生的齿侧间隙，并且其中，齿轮齿条传动控制器采用主从式控制结构，在控制结构下，当所需扭矩不断增大并高于预紧力产生的扭矩时，从驱动器也逐渐越过补偿后的间隙并开始辅助主驱动器共同驱动负载。与现有技术相比，本专利技术的四电机驱动同步及消隙控制方法具有以下有益效果及优点：1.良好的同步效果。单轴单边驱动很难将驱动力龙门移动平台的重心，其产生的不对称的驱动力会造成丝杠的弯曲变形而影响系统的定位精度。2.良好的消隙效果。在双电机驱动方式下，齿条位于工作台两侧对称放置，电机通过驱动两边的齿轮共同驱动工作台的运动。由于采用双电机驱动，即每侧紧使用一台电机驱动齿轮，系统在换向时，由于齿轮与齿条之间存在齿轮的侧向间隙，会使进给运动反向滞后，从而影响传动精度。3.充足的驱动力。在双电机驱动下，每侧使用一台电机驱动，其驱动力受限于电机的驱动能力，因此驱动力有限，很难驱动大型的龙门式或桥式机床。在四电机驱动下，每侧由两台电机驱动，除去消隙控制外，两台电机可以合力对其驱动，因此可以提供充足的驱动力。4.灵活开放的控制方式。传统的控制器通常集成于伺服器驱动器中，其控制环路被封闭在驱动器中，数控系统无法依据具体的应用场景对其做修改和调整，因而封闭不灵活。本专利技术借助于实时以太网总线高实时性、高带宽以及高同步性的特点，将大部分控制策略从驱动器中抽离并安置于设备控制器中，因而控制方式更加灵活。附图说明图1为本专利技术方法模块流程图；图2为四电机驱动龙门移动平台电气连接图；图3为划分插补运算图；图4为分区域PID控制器分区结构图；图5为齿轮齿条传动控制器结构图。具体实施方式下面结合附图，对本专利技术的具体实施方式进行详细描述，但应当理解本专利技术的保护范围并不受具体实施方式的限制。除非另有其它明确表示，否则在整个说明书和权利要求书中，术语“包括”或其变换如“包含”或“包括有”等等将被理解为包括所陈述的元件或组成部分，而并未排除其它元件或其它组成部分。图1为本专利技术方法模块流程图。如图1所示，本专利技术的控制方法可分为插补运算处理和同步及消隙控制两个阶段。在插补运算处理阶段，开放式设备控制器将原有插补运算进行分离，划分为粗插补和精插补两部分。粗插补的插补周期保持不变，将精插补的插补周期调整为粗插补的1/n，以匹配伺服驱动器的控制周期，提高控制频率。在同步及消隙控制阶段，其过程又可分为双轴同步控制和双电机驱动消隙控制两部分。对于双轴同步控制，采用双轴并行同步控制方法，控制对象为两组轴中的主控轴（Master）。首先依据两个同步轴的反馈位置计算同步误差，并将它作为输入量输入到双轴并行同步控制器中，控制器经过运算得到补偿量，最后采用补偿量分配策略将补偿量通过实时以太网总线分配到两个同步轴中。对于双电机驱动消隙控制，则采用齿轮齿条传动控制方法，该方法可使主从轴均输出相同的扭本文档来自技高网...

【技术保护点】
1.一种CRTS‑III型轨道板模具清理装置的四电机驱动同步及消隙控制方法，其特征在于，所述控制方法包括以下步骤：构建四电机驱动系统电气连接结构，将四台电机分为两组，其中，每组中的两台电机分别驱动主控轴和被控轴；在插补运算处理阶段，将控制器运动控制中的插补运算分离，以便将所述插补运算划分为粗插补和精插补两部分；在同步及消隙控制阶段，对于双轴同步控制，采用双轴并行同步控制方法，控制对象为两组轴中的主控轴；以及对于消隙控制，采用双电机驱动消隙控制方法，控制对象为每组电机所驱动的主控轴和被控轴。

【技术特征摘要】
1.一种CRTS-III型轨道板模具清理装置的四电机驱动同步及消隙控制方法，其特征在于，所述控制方法包括以下步骤：构建四电机驱动系统电气连接结构，将四台电机分为两组，其中，每组中的两台电机分别驱动主控轴和被控轴；在插补运算处理阶段，将控制器运动控制中的插补运算分离，以便将所述插补运算划分为粗插补和精插补两部分；在同步及消隙控制阶段，对于双轴同步控制，采用双轴并行同步控制方法，控制对象为两组轴中的主控轴；以及对于消隙控制，采用双电机驱动消隙控制方法，控制对象为每组电机所驱动的主控轴和被控轴。2.如权利要求1所述的控制方法，其特征在于，所述电气连接结构采用实时以太网总线以菊花链的形式将设备控制器与四套伺服驱动器和电机连接在一起，并将所述四套伺服驱动器和电机划分为第一组伺服驱动器和电机和第二组伺服驱动器和电机，其中，位于龙门移动平台同侧的两套伺服驱动器和电机被划分为同一组。3.如权利要求1所述的控制方法，其特征在于，所述粗插补的插补周期与原开放式设备控制器的插补周期保持一致。4.如权利要求3所述的控制方法，其特征在于，所述精插补的插补周期被设置为粗插补的插补周期的1/n，以匹配伺服驱动器的控制周期，提高控制频率。5.如权利要求1所述的控制方法，其特征在于，所述双轴并行同步控制方法具体...

【专利技术属性】
技术研发人员：周兆春，荣慧明，王洪波，曹凤洁，刘秋晨，吴颖强，李备备，阮涛，
申请(专利权)人：中铁十四局集团房桥有限公司，
类型：发明
国别省市：北京,11