双轴一体驱动器同步控制方法及装置制造方法及图纸

本申请公开提供了双轴一体驱动器同步控制方法及装置，其中，该方法包括：根据1轴位置指令参考值Pref1、1轴位置反馈Pfbk1和2轴位置反馈Pfbk2计算1轴速度指令参考值Vref1和1轴电流指令前馈值Tfwd1；根据所述1轴速度指令参考值Vref1和1轴实际速度Vfbk1计算1轴电流指令参考值Tref1；根据所述1轴电流指令参考值Tref1、所述1轴电流指令前馈值Tfwd1和1轴实际电流Tfbk1计算输出电压U，所述输出电压U用于控制电机旋转，解决了现有技术中，其中一个轴出故障报警后，另外一个轴不能进行同步跟随停止的问题。止的问题。止的问题。

【技术实现步骤摘要】
双轴一体驱动器同步控制方法及装置


[0001]本专利技术涉及电机控制
，具体涉及双轴一体驱动器同步控制方法及装置。

技术介绍

[0002]现有技术，应用于龙门机构的伺服同步控制方法及系统，龙门机构由两套伺服系统共同驱动，两套伺服系统中的任一台伺服驱动器通过比较其所控制的伺服电机和另外一台伺服电机位置关系，调整其所控制的伺服电机的速度，实现两电机的同步。
[0003]现有技术缺点：1、需要2个独立伺服外部物理接线，导致操作复杂，可靠性变低；
[0004]2、需要2个独立伺服去进行数据交互，同步实时性不够；3、其中一个轴出故障报警停止后，另外一个轴不具备同步跟随停止的功能算法。

技术实现思路

[0005]因此，本专利技术要解决的技术问题在于克服现有技术中，需要2个独立伺服外部物理接线，导致操作复杂，可靠性变低；需要2个独立伺服去进行数据交互，同步实时性不够；其中一个轴出故障报警停止后，另外一个轴不能进行同步跟随停止的问题，从而提供双轴一体驱动器同步控制方法及装置。
[0006]为解决上述技术问题，本专利技术公开实施例至少提供双轴一体驱动器同步控制方法及装置。
[0007]第一方面，本专利技术公开实施例提供了双轴一体驱动器同步控制方法，包括：
[0008]根据1轴位置指令参考值Pref1、1轴位置反馈Pfbk1和2轴位置反馈Pfbk2计算1轴速度指令参考值Vref1和1轴电流指令前馈值Tfwd1；
[0009]根据所述1轴速度指令参考值Vref1和1轴实际速度Vfbk1计算1轴电流指令参考值Tref1；
[0010]根据所述1轴电流指令参考值Tref1、所述1轴电流指令前馈值Tfwd1和1轴实际电流Tfbk1计算输出电压U，所述输出电压U用于控制电机旋转。
[0011]可选地，所述根据1轴位置指令参考值Pref1、1轴位置反馈Pfbk1和2轴位置反馈Pfbk2计算1轴速度指令参考值Vref1和1轴电流指令前馈值Tfwd1，包括：
[0012]Err1＝Pref1
‑
Pfbk1
[0013]Err2＝Pfbk1
‑
Pfbk2
[0014][0015][0016]式中，Kp为比例系数，Ki为积分系数，Kpm为两轴差值比例系数，(k)表示在k时刻的数据，t表示时间，LPF为滤波器，Kf为第一前馈系数和Kfm为第二前馈系数。
[0017]可选地，所述根据所述1轴速度指令参考值Vref1和1轴实际速度Vfbk1计算1轴电
流指令参考值Tref1，包括：
[0018]Err3＝Vref1
‑
Vfbk1
[0019][0020]式中，Kp1为比例系数，Ki1为积分系数和(k)表示在k时刻的数据。
[0021]可选地，所述根据所述1轴电流指令参考值Tref1、所述1轴电流指令前馈值Tfwd1和1轴实际电流Tfbk1计算输出电压U，包括：
[0022]Err4＝Tref1+Tfwd1
‑
Tfbk1
[0023][0024]式中，Kp2为比例系数，Ki2为积分系数和(k)表示在k时刻的数据。
[0025]第二方面，本专利技术公开实施例还提供双轴一体驱动器同步控制装置，包括：
[0026]第一计算模块，用于根据1轴位置指令参考值Pref1、1轴位置反馈Pfbk1和2轴位置反馈Pfbk2计算1轴速度指令参考值Vref1和1轴电流指令前馈值Tfwd1；
[0027]第二计算模块，用于根据所述1轴速度指令参考值Vref1和1轴实际速度Vfbk1计算1轴电流指令参考值Tref1；
[0028]第三计算模块，用于根据所述1轴电流指令参考值Tref1、所述1轴电流指令前馈值Tfwd1和1轴实际电流Tfbk1计算输出电压U，所述输出电压U用于控制电机旋转。
[0029]可选地，所述根据1轴位置指令参考值Pref1、1轴位置反馈Pfbk1和2轴位置反馈Pfbk2计算1轴速度指令参考值Vref1和1轴电流指令前馈值Tfwd1，包括：
[0030]Err1＝Pref1
‑
Pfbk1
[0031]Err2＝Pfbk1
‑
Pfbk2
[0032][0033][0034]式中，Kp为比例系数，Ki为积分系数，Kpm为两轴差值比例系数，(k)表示在k时刻的数据，t表示时间，LPF为滤波器，Kf为第一前馈系数和Kfm为第二前馈系数。
[0035]可选地，所述根据所述1轴速度指令参考值Vref1和1轴实际速度Vfbk1计算1轴电流指令参考值Tref1，包括：
[0036]Err3＝Vref1
‑
Vfbk1
[0037][0038]式中，Kp1为比例系数，Ki1为积分系数和(k)表示在k时刻的数据。
[0039]第三方面，本专利技术公开实施例还提供一种计算机设备，包括：处理器、存储器和总线，所述存储器存储有所述处理器可执行的机器可读指令，当计算机设备运行时，所述处理器与所述存储器之间通过总线通信，所述机器可读指令被所述处理器执行时执行上述第一方面，或第一方面中任一种可能的实施方式中的步骤。
[0040]第四方面，本专利技术公开实施例还提供一种计算机可读存储介质，该计算机可读存储介质上存储有计算机程序，该计算机程序被处理器运行时执行上述第一方面，或第一方面中任一种可能的实施方式中的步骤。
[0041]本专利技术的实施例提供的技术方案可以具有以下有益效果：
[0042]根据1轴位置指令参考值Pref1、1轴位置反馈Pfbk1和2轴位置反馈Pfbk2计算1轴速度指令参考值Vref1和1轴电流指令前馈值Tfwd1；根据所述1轴速度指令参考值Vref1和1轴实际速度Vfbk1计算1轴电流指令参考值Tref1；根据所述1轴电流指令参考值Tref1、所述1轴电流指令前馈值Tfwd1和1轴实际电流Tfbk1计算输出电压U，所述输出电压U用于控制电机旋转，本专利技术设计双轴一体的伺服驱动器，可同时控制两个伺服电机，适用于使用双电机驱动的龙门机构，无需额外接线即可实现龙门同步功能；内部具有优化的龙门同步算法，具有高实时性以及高动态响应性，可在一个伺服周期内把两个伺服电机的位置，速度，转矩电流信息进行交叉运算，具有优良的双轴同步性能；同时针对龙门应力不一致情况，可以无需外部应力检测机构，内部通过检测两个电机之间的转矩电流数据即可间接得到龙门力矩差；针对龙门所需求的同步性，当其中一个电机发生异常时候，通过内部的同步跟随算法进行同步跟随停止，来确保两个电机之间的位置同步；当其中一个电机发生异常时候，通过内部的同步跟随算法进行同步跟随停止，来确保两个电机之间的位置同步；当前轴以报警轴的位置反馈作为位置指令进行跟随控制，能确保两轴之间的同步偏差是受控的，进而保证龙门之间的位置偏差最小，保护龙门机构不受外力损坏；通过两个龙门轴共享的位置，速度，电流数据，经过内部的龙门同步本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.双轴一体驱动器同步控制方法，其特征在于，包括：根据1轴位置指令参考值Pref1、1轴位置反馈Pfbk1和2轴位置反馈Pfbk2计算1轴速度指令参考值Vref1和1轴电流指令前馈值Tfwd1；根据所述1轴速度指令参考值Vref1和1轴实际速度Vfbk1计算1轴电流指令参考值Tref1；根据所述1轴电流指令参考值Tref1、所述1轴电流指令前馈值Tfwd1和1轴实际电流Tfbk1计算输出电压U，所述输出电压U用于控制电机旋转。2.根据权利要求1所述的方法，其特征在于，所述根据1轴位置指令参考值Pref1、1轴位置反馈Pfbk1和2轴位置反馈Pfbk2计算1轴速度指令参考值Vref1和1轴电流指令前馈值Tfwd1，包括：Err1＝Pref1
‑
Pfbk1Err2＝Pfbk1
‑
Pfbk2Pfbk2式中，Kp为比例系数，Ki为积分系数，Kpm为两轴差值比例系数，(k)表示在k时刻的数据，t表示时间，LPF为滤波器，Kf为第一前馈系数和Kfm为第二前馈系数。3.根据权利要求1所述的方法，其特征在于，所述根据所述1轴速度指令参考值Vref1和1轴实际速度Vfbk1计算1轴电流指令参考值Tref1，包括：Err3＝Vref1
‑
Vfbk1式中，Kp1为比例系数，Ki1为积分系数和(k)表示在k时刻的数据。4.根据权利要求1所述的方法，其特征在于，所述根据所述1轴电流指令参考值Tref1、所述1轴电流指令前馈值Tfwd1和1轴实际电流Tfbk1计算输出电压U，包括：Err4＝Tref1+Tfwd1
‑
Tfbk1式中，Kp2为比例系数，Ki2为积分系数和(k)表示在k时刻的数据。5.双轴一体驱动器同步控制装置，其特征在于，包括：第一计算模块，用于根据1轴位置指令...

【专利技术属性】
技术研发人员：廖志辉，王远洋，
申请(专利权)人：深圳市杰美康机电有限公司，
类型：发明
国别省市：