一种多电机同步驱动控制系统及方法与流程
本发明涉及电机驱动,具体而言,涉及一种多电机同步驱动控制系统及方法。
背景技术:
1、随着装备负载转动惯量越来越大,单一电机不能满足负载驱动控制需求。为了实现对负载大惯量、高速、精准运动控制,现阶段一般采取多电机力矩同步控制。即一台驱动器作为主驱动,其他驱动器作为从驱动。上位机向主驱动器发送速度控制指令,主驱动器收到上位机指令后进行指令分解,向从驱动器发送力矩控制指令,实现多电机同步驱动负载,进而达到增大电机的输出带载能力的效果。
2、但当输出是力矩同步方式时,即对所有电机输出的力矩基本相同,但不会对电机的速度进行控制,一旦由于外部机构原因,某台电机负载阻力大,其他负载阻力小时,会造成某电机速度卡滞、位置误差增大。
3、另外,现有技术中还采用另一种同步解决方案,即速度同步控制方案,由主驱动器向从驱动器发送速度指令,多台电机按照相同速度运转,同样可以实现多电机同步驱动负载的效果。
4、但当输出是速度同步方式时,在电机带动负载运转过程中,由于不同电机速度会有误差,进而会造成电机之间运动位置有累计差异,同样会造成负载运动不同步、卡滞、扭转,甚至损坏的危害。
5、因此,研究如何优化控制系统的结构,减小多电机驱动同步控制误差,降低有同步误差造成的负载故障,具有重要意义。
6、在专利cn112203610b中公开了一种外科机器人工具多电机致动器和控制器,包括输出联接件,所述输出联接件被构造成联接到外科工具;第一输入联接件和第二输入联接件,所述第一输入联接件和所述第二输入联接件各自联接以通过传输装置驱动所述输出联接件;第一电机,所述第一电机具有联接的驱动器联接件以根据第一电机输入命令驱动所述第一输入联接件;第二电机,所述第二电机具有联接的驱动器联接件以根据第二电机输入命令驱动所述第二输入联接件;和控制器。在一个实施方案中,输出联接件使机器人外科内窥镜围绕输出联接件的纵向轴线旋转。第一电机驱动第一输入联接件,同时由驱动第二输入联接件的第二电机进行辅助。第一补偿器基于位置误差并根据位置控制定律产生第一电机输入,并且第二补偿器基于位置误差并根据阻抗控制定律产生第二电机输入。在另一个实施方案中,第二补偿器接收第一电机的测量扭矩。能够改善主电机子系统和辅助电机子系统之间的工作负载的平衡,但并不能够解决多电机同步驱动负载时,容易具有的同步误差较大,以及负载故障率较高的问题。
技术实现思路
1、有鉴于此,本发明旨在提出一种多电机同步驱动控制系统及方法,以解决现有技术中存在的多电机同步控制过程中,不同控制方式下,电机的位置或速度误差较大,以及由于不同电机的同步误差所造成的负载故障率较高的问题;以此达到优化控制系统的结构设置,提升控制系统的运行可靠性和稳定性,大幅减小多电机驱动同步控制的误差,降低由于同步误差造成的负载故障,进而提高系统运行的安全性和效率。
2、为达到上述目的,本发明的技术方案是这样实现的:
3、本发明涉及的一种多电机同步驱动控制系统及方法,所述一种多电机同步驱动控制系统,包括上位机控制模块、驱动器模块和电机模块;上位机控制模块依次通过驱动器模块、电机模块与负载连接;其中,驱动器模块包括主驱动器和从驱动器;电机模块包括主电机和从电机;上位机控制模块依次通过主驱动器、主电机与负载连接,上位机控制模块依次通过从驱动器、从电机与负载连接;从驱动器、从电机均设置n个,n为正整数。
4、进一步,每个从驱动器的一端通过对应位置的从电机与负载连接,每个从驱动器的另一端与上位机控制模块连接。
5、进一步,电机模块采用交流永磁同步电机。
6、进一步,系统包括线缆;线缆包括第一导线;第一导线设置在上位机控制模块与驱动器模块之间;第一导线设置n+1条;上位机控制模块通过其中一条第一导线发送主指令至主驱动器;上位机控制模块通过n条不同的第一导线发送从指令至对应的从驱动器中。
7、进一步,线缆还包括第二导线;第二导线设置在驱动器模块与电机模块之间;第二导线设置2(n+1)条;每两条第二导线为一组,分别设置在主驱动器和主电机、不同的从驱动器和与之对应的从电机之间。
8、进一步,线缆还包括第三导线;第三导线设置在电机模块与负载之间;第三导线设置n+1条;主电机、不同的从电机均通过第三导线与负载对应接口连接。
9、进一步,线缆还包括第四导线;第四导线设置在电机模块与上位机控制模块之间;第四导线设置n+1条;每条第四导线的一端与主电机或从电机连接,每条第四导线的另一端与上位机控制模块的对应接口连接。
10、一种多电机同步驱动控制方法,所述方法应用于所述的一种多电机同步驱动控制系统,所述方法包括以下步骤:
11、步骤一、上位机控制模块接收外部输入指令,且同步接收电机模块中主电机和各个从电机的位置反馈;
12、步骤二、上位机控制模块经过对电机模块内各个电机速度、位置、指令的综合解算,同时向主驱动器和各个从驱动器输出对应的指令,用于同步控制负载按需稳定运行。
13、进一步,步骤二包括:
14、步骤s21:上位机控制模块根据输入指令及主反馈采用误差pid控制算法,给出主驱动器的输出指令;
15、步骤s22:分别计算各个从电机的位置反馈结果与主电机的位置反馈结果的差值后,并分别通过pi运算实现在主驱动器指令的结果上进行修正,形成针对各个从驱动器的输出指令。
16、进一步,步骤s22包括:
17、步骤s221:令i=1;
18、步骤s222:上位机控制模块针对从位置反馈i的反馈结果si,计算从位置反馈i的反馈结果si和主位置反馈的结果s0之间的差值△si,将差值△si进行第i次pi运算,在主驱动器指令的结果上进行修正,形成对第i个从驱动器的输出指令;
19、步骤s223:判断是否i>n;是,执行步骤s225;否,执行步骤s224;
20、步骤s224:令i=i+1;返回步骤s222;
21、步骤s225:将所形成的各个从驱动器的控制指令,通过各从指令输出线路及第一导线同步发送至各从驱动器,驱动器模块按照上位机控制模块的输出指令控制各自对应的从电机。对驱动器模块内的主驱动器和各个从驱动器的统一、实时、同时控制,从而实现对负载稳定同步控制。
22、相对于现有技术,本发明所述的一种多电机同步驱动控制系统及方法,具有以下有益效果:
23、通过所述系统的设置,能够实现优化控制系统的结构设置,提升控制系统的运行可靠性和稳定性,大幅减小多电机驱动同步控制的误差,降低由于同步误差造成的负载故障,进而提高系统运行的安全性和效率。
1.一种多电机同步驱动控制系统,其特征在于,包括上位机控制模块(1)、驱动器模块(2)和电机模块(3);上位机控制模块(1)依次通过驱动器模块(2)、电机模块(3)与负载(4)连接;其中,驱动器模块(2)包括主驱动器(21)和从驱动器(22);电机模块(3)包括主电机(31)和从电机(32);上位机控制模块(1)依次通过主驱动器(21)、主电机(31)与负载(4)连接,上位机控制模块(1)依次通过从驱动器(22)、从电机(32)与负载(4)连接;从驱动器(22)、从电机(32)均设置n个,n为正整数。
2.根据权利要求1所述的一种多电机同步驱动控制系统,其特征在于,每个所述从驱动器(22)的一端通过对应位置的从电机(32)与负载(4)连接,每个从驱动器(22)的另一端与上位机控制模块(1)连接。
3.根据权利要求1所述的一种多电机同步驱动控制系统,其特征在于,所述电机模块(3)采用交流永磁同步电机。
4.根据权利要求1所述的一种多电机同步驱动控制系统,其特征在于,所述系统包括线缆(5);线缆(5)包括第一导线(51);第一导线(51)设置在上位机控制模块(1)与驱动器模块(2)之间;第一导线(51)设置n+1条;上位机控制模块(1)通过其中一条第一导线(51)发送主指令至主驱动器(21);上位机控制模块(1)通过n条不同的第一导线(51)发送从指令至对应的从驱动器(22)中。
5.根据权利要求4所述的一种多电机同步驱动控制系统,其特征在于,所述线缆(5)还包括第二导线(52);第二导线(52)设置在驱动器模块(2)与电机模块(3)之间;第二导线(52)设置2(n+1)条;每两条第二导线(52)为一组,分别设置在主驱动器(21)和主电机(31)、不同的从驱动器(22)和与之对应的从电机(32)之间。
6.根据权利要求4所述的一种多电机同步驱动控制系统,其特征在于,所述线缆(5)还包括第三导线(53);第三导线(53)设置在电机模块(3)与负载(4)之间;第三导线(53)设置n+1条;主电机(31)、不同的从电机(32)均通过第三导线(53)与负载(4)对应接口连接。
7.根据权利要求4所述的一种多电机同步驱动控制系统,其特征在于,所述线缆(5)还包括第四导线(54);第四导线(54)设置在电机模块(3)与上位机控制模块(1)之间;第四导线(54)设置n+1条;每条第四导线(54)的一端与主电机(31)或从电机(32)连接,每条第四导线(54)的另一端与上位机控制模块(1)的对应接口连接。
8.一种多电机同步驱动控制方法,其特征在于,所述方法应用于权利要求1-7中任一项所述的一种多电机同步驱动控制系统,所述方法包括以下步骤:
9.根据权利要求8所述的一种多电机同步驱动控制方法,其特征在于,所述步骤二包括:
10.根据权利要求9所述的一种多电机同步驱动控制方法,其特征在于,所述步骤s22包括:
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com