《双电机同步控制系统及其同步控制的方法.pdf》由会员分享,可在线阅读,更多相关《双电机同步控制系统及其同步控制的方法.pdf(11页珍藏版)》请在专利查询网上搜索。
1、(10)申请公布号 CN 102904496 A (43)申请公布日 2013.01.30 C N 1 0 2 9 0 4 4 9 6 A *CN102904496A* (21)申请号 201210369226.X (22)申请日 2012.09.28 H02P 5/50(2006.01) (71)申请人苏州生物医学工程技术研究所 地址 215163 江苏省苏州市高新区科技城科 灵路88号 (72)发明人袁刚 蒯多杰 王邺 (54) 发明名称 双电机同步控制系统及其同步控制的方法 (57) 摘要 一种双电机同步控制系统,包括:两个电机串 级控制部以及一同步控制器。其中,电机串级控制 部,用于设。
2、定电机的参数信息以及控制模式,并根 据参数信息以及控制模式驱动电机运转,根据控 制模式输出电机的实际转速或者实际位置,同步 控制器,用于接收电机的实际转速或者实际位置, 并根据设定转速或设定位置对电机的运动进行补 偿。本发明中的双电机同步控制系统降低控制成 本,提高运动精度。 (51)Int.Cl. 权利要求书2页 说明书5页 附图3页 (19)中华人民共和国国家知识产权局 (12)发明专利申请 权利要求书 2 页 说明书 5 页 附图 3 页 1/2页 2 1.一种双电机同步控制系统,包括两个电机串级控制部和一个同步控制器,其中: 所述电机串级控制部,包括: 电机,用于带动负载运动; 电机控。
3、制模块,用于设定所述电机的参数信息以及控制模式; 电机驱动模块,用于接收所述电机控制模块的参数信息以及控制模式,并将所述参数 信息配置给所述电机,根据所述控制模式驱动电机运转; 传感器模块,用于感应所述电机的运动,并根据电机控制模式输出所述电机的实际转 速或者实际位置; 所述同步控制器,包括: 数据采集模块,用于根据电机控制模式采集所述传感器模块输出的实际转速或者实际 位置,形成模拟信号量; A/D数据转换模块,用于将所述模拟信号量转换为数字信息; 补偿器模块,用于对所述数字信息进行补偿,并输出补偿数字信息; D/A数据转换模块,用于将所述补偿数字信息转换为补偿模拟信息,并将所述补偿模拟 信息。
4、反馈给所述电机串级控制部,对所述电机的运动进行修正。 2.如权利要求1所述的双电机同步控制系统,其特征在于,所述补偿器模块包括:相角 补偿,用于对所述数字信息的相角滞后进行补偿; 幅值补偿,用于对所述数字信息的幅值损失进行补偿。 3.如权利要求1所述的双电机同步控制系统,其特征在于,所述电机控制模式包括速 度控制模式与位置控制模式。 4.如权利要求3所述的双电机同步控制系统,其特征在于,所述电机的参数信息包括 所述电机的设定转速以及所述电机的设定位置。 5.如权利要求4所述的双电机同步控制系统,其特征在于,所述补偿器模块在速度控 制模式下对两个所述电机的实际转速以及设定转速分别求转速差值,并根。
5、据所述转速差值 获取所述补偿数字信息。 6.如权利要求4所述的双电机同步控制系统,其特征在于,所述补偿器模块在位置控 制模式下对两个所述电机的实际位置以及设定位置分别求位置差值,并根据所述位置差值 获取所述补偿数字信息。 7.一种双电机同步控制的方法,包括: 设定所述电机的控制参数以及控制模式; 根据所述控制参数以及控制模式驱动电机运转; 感应所述电机的运动,并根据电机控制模式输出所述电机的实际转速或者实际位置, 并形成模拟信号量; 将所述模拟信号量转换为数字信息; 对所述数字信息进行补偿,并输出补偿数字信息,将所述补偿数字信息转换为补偿模 拟信息; 将所述补偿模拟信息反馈给两个所述电机串级控。
6、制部,对两个所述电机的运动进行修 正。 8.如权利要求7所述的双电机同步控制的方法,其特征在于,利用柏德图对所述数字 权 利 要 求 书CN 102904496 A 2/2页 3 信息进行补偿时包括相角补偿与幅值补偿。 9.如权利要求7所述的双电机同步控制的方法,其特征在于,所述电机控制模式包括 速度控制模式与位置控制模式。 10.如权利要求9所述的双电机同步控制的方法,其特征在于,所述电机的参数信息包 括所述电机的设定转速以及所述电机的设定位置。 11.如权利要求10所述的双电机同步控制的方法,其特征在于, 所述对所述数字信息进行补偿,并输出补偿数字信息,将所述补偿数字信息转换为补 偿模拟信。
7、息的步骤包括: 在速度控制模式下获取所述电机的实际转速; 对实际转速与设定转速求差以获取转速差值;以及 根据所述转速差值进行补偿,以获取补偿数字信息。 12.如权利要求10所述的双电机同步控制的方法,其特征在于, 所述对所述数字信息进行补偿,并输出补偿数字信息,将所述补偿数字信息转换为补 偿模拟信息的步骤包括: 在位置控制模式下获取所述电机的实际位置; 对实际位置与设定位置求差以获取位置差值;以及 根据所述位置差值进行补偿,以获取补偿数字信息。 权 利 要 求 书CN 102904496 A 1/5页 4 双电机同步控制系统及其同步控制的方法 技术领域 0001 本发明涉及自动控制领域,尤其涉。
8、及一种双电机同步控制系统及其同步控制的方 法。 背景技术 0002 随着运动控制技术的发展,电机同步控制技术在各个技术领域中得到了越来越多 的应用。随之而来的对电机同步控制技术的要求也越来越高,除了要求在一些常规系统中 能够进行高精度的控制效果,还要在一些特殊需求中能够得到很好的应用。比如:医用CT 的一种工作方式是螺旋扫描,在这种方式下,要求CT机旋转机架做匀速转动,载有患者的 运动床做匀速水平运动,两者具有一定的位置对应关系以达到均匀投影采样的目的。旋转 机架承载着系统的各个模块,与运动床的驱动电机负载相差悬殊,大惯量调速响应缓慢,但 容易维持运行状态,并且,两电机(旋转机架电机和运动床电。
9、机)在同步控制过程中所受到 的负载扰动形式不同,一个为周期性大负载扰动,一个为恒值小扰动,这就使得两个电机在 同步过程中会出现幅值和相角不一致,影响同步效果。 0003 现有的医用CT产品中,传动链驱动方式增加了机架内部件数量,步进电机固有的 丢步问题又降低了运动的精度,而且所使用的运动控制卡不仅成本较高而且功能单一,对 于不同电机型号的控制不具有广泛的兼容性,对于一些特殊应用不能很好地实现,局限性 很大。 发明内容 0004 有鉴于此,有必要提供一种双电机同步控制系统及双电机同步控制的方法,降低 控制成本,提高运动精度。 0005 本发明提供的双电机同步控制系统包括两个电机串级控制部以及一同。
10、步控制器。 其中,所述电机串级控制部包括:电机,用于带动负载运动;电机控制模块,用于设定所述 电机的参数信息以及控制模式;电机驱动模块,用于接收所述电机控制模块的参数信息以 及控制模式,并将所述参数信息配置给所述电机,根据所述控制模式驱动电机运转;传感器 模块,用于感应所述电机的运动,并根据电机控制模式输出所述电机的实际转速或者实际 位置;所述同步控制器,包括:数据采集模块,用于根据电机控制模式采集所述传感器模块 输出的实际转速或者实际位置,形成模拟信号量;A/D数据转换模块,用于将所述模拟信号 量转换为数字信息;补偿器模块,用于对所述数字信息进行补偿,并输出补偿数字信息;D/ A数据转换模块。
11、,用于将所述补偿数字信息转换为补偿模拟信息,并将所述补偿模拟信息反 馈给所述电机串级控制部,对所述电机的运动进行修正。 0006 本发明提供的双电机同步控制的方法,包括:设定电机的控制参数以及控制模式; 根据所述控制参数以及控制模式驱动电机运转;感应所述电机的运动,并根据电机控制模 式输出所述电机的实际转速或者实际位置,并形成模拟信号量;将所述模拟信号量转换为 数字信息;对所述数字信息进行补偿,并输出补偿数字信息,将所述补偿数字信息转换为补 说 明 书CN 102904496 A 2/5页 5 偿模拟信息;将所述补偿模拟信息反馈给电机串级控制部,对所述电机的运动进行修正。 0007 本发明所提。
12、供的双电机同步控制系统及双电机同步控制的方法通过补偿器模块 对实际转速与实际位置进行补偿,以实现对电机的运动修正,降低控制成本,提高运动精 度。 附图说明 0008 图1为本发明一实施方式中双电机同步控制系统的结构图; 0009 图2为本发明一实施方式中双电机同步控制的方法的流程图; 0010 图3为图2中速度控制模式下步骤S108的具体步骤图; 0011 图4为图2中位置控制模式下步骤S108的具体步骤图。 具体实施方式 0012 下面详细描述本发明的实施例,所述实施例的示例在附图中示出,其中自始至终 相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附 图描述的实。
13、施例是示例性的,仅用于解释本发明,而不能理解为对本发明的限制。 0013 在本发明的描述中,术语“内”、“外”、“纵向”、“横向”、“上”、“下”、“顶”、“底”等指 示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明而不是 要求本发明必须以特定的方位构造和操作,因此不能理解为对本发明的限制。 0014 请参阅图1,图1所示为本发明一实施方式中双电机同步控制系统的结构图。 0015 在本实施方式中,双电机同步控制系统包括:两个电机串级控制部10以及一个同 步控制器20。 0016 在本实施方式中,电机串级控制部10包括电机100、电机控制模块102、电机驱动 模块104以。
14、及传感器模块106。 0017 在本实施方式中,电机100用于带动负载运动。 0018 所述电机控制模块102用于设定电机100的参数信息以及控制模式。在本实施方 式中,电机100的参数信息包括:电机100的设定转速以及所述电机100的设定位置,电机 100的控制模式包括:速度控制模式以及位置控制模式。 0019 在本实施方式中,电机控制模块102包括速度环PI控制模块与位置环PI控制模 块。其中,速度环PI控制模块设置电机100的设定转速,位置环PI控制模块设置电机100 的设定位置。 0020 电机驱动模块104用于接收所述电机控制模块102的参数信息以及控制模式,并 将所述参数信息配置给。
15、所述电机100,根据所述控制模式驱动电机100运转。 0021 所述传感器模块106用于感应所述电机100的运动,并根据电机控制模式输出所 述电机100的实际转速或者实际位置。 0022 在本实施方中,同步控制器20包括:数据采集模块200、A/D数据转换模块202、补 偿器模块204以及D/A数据转换模块206。 0023 在本实施方式中,数据采集模块200用于根据电机控制模式采集所述传感器模块 106输出的实际转速或者实际位置,形成模拟信号量。 0024 在本实施方式中,当电机控制模式为速度控制模式,则所述数据采集模块200采 说 明 书CN 102904496 A 3/5页 6 集所述传。
16、感器模块106输出的实际转速,当电机控制模式为位置控制模式,则所述数据采 集模块200采集所述传感器模块106输出的实际位置。 0025 A/D数据转换模块202用于将所述模拟信号量转换为数字信息。 0026 补偿器模块204对所述数字信息进行补偿,并输出补偿数字信息。 0027 在本实施方式中,所述补偿器模块204包括相角补偿与幅值补偿,其中,相角补 偿,用于对所述数字信息的相角滞后进行补偿;幅值补偿,用于对所述数字信息的幅值损失 进行补偿。 0028 在本实施方式中,所述补偿器模块204在速度控制模式下对电机100的实际转速 以及设定转速求转速差值,并根据所述转速差值获取所述补偿数字信息。。
17、 0029 在本实施方式中,所述补偿器模块204在位置控制模式下对电机100的实际位置 以及设定位置求位置差值,并根据所述位置差值获取所述补偿数字信息。 0030 在本实施方式中,补偿器模块204是利用基于改进后的频率复合校正方法,通过 逐次迭代,保证了一电机对另一电机的周期性干扰信号进行快速准确的跟踪,以提高系统 的同步性。 0031 在本实施方式中,为了保证一电机能够跟踪到另一电机的周期性负载,补偿器模 块204的设计须考虑的对象为另一电机输出对另一电机输入的传递函数G 22 ,一电机输出对 一电机负载周期扰动的传递函数G 13 ,以及另一电机输出对另一电机输出以及负载扰动的传 递函数G 。
18、23 。 0032 补偿器模块204分析一电机的所述数字信息中的幅值与相角损失,并补偿传递函 数G 22 带来的幅值和相角损失,通过改进后改的频率复合校正方法得到补偿器模块204的传 递函数G f1 ,将一电机视为另一电机的干扰,补偿传递函数G 23 带来的幅值和相角损失,所设 计的补偿器模块204的传递函数为G f2 ,因此同步控制系统的补偿器模块204的传递函数即 为G f G f1 G f2 。 0033 例如,以另一电机为对象,由其经过串级控制后的开环传递函数G 22 绘制伯德 (bode)图,读出周期性干扰的频率为w时的系统相角和幅值损失分别为和k,选取: 0034 a(1+sin)。
19、/(1-sin) 0035 为系统的分度系数,令: 0036 0037 进行变量代换后,取: 0038 0039 验证G的相角为,再取: 0040 0041 这样就在不影响系统稳定性的情况下保证了经过串级控制后损失的相角和幅值 能够得到补偿。需要注意的是当系统本身的相角损失较大时,一级校正不能满足补偿需求, 应选择合适的分度系数,进行多级补偿。 0042 D/A数据转换模块206用于将所述补偿数字信息转换为补偿模拟信息,并将所述 补偿模拟信息反馈给所述电机串级控制部10,对所述电机100的运动进行修正。 说 明 书CN 102904496 A 4/5页 7 0043 请参阅图2,图2所示为本发。
20、明一实施方式中双电机同步控制的方法的流程图。 0044 在本实施方式中,双电机控制方式包括:交叉耦合控制以及主从同步控制。 0045 在步骤S100,电机控制模块102设定电机100的控制参数以及控制模式。在本实 施方式中,电机100的参数信息包括:电机100的设定转速以及所述电机100的设定位置, 电机100的控制模式包括:速度控制模式以及位置控制模式。 0046 在步骤S102,电机驱动模块104根据所述控制参数以及控制模式驱动电机100运 转。 0047 在步骤S104传感器模块106感应所述电机100的运动,并根据电机100控制模式 输出所述电机100的实际转速或者实际位置,并形成模拟。
21、信号量。在本实施方式中,电机 100的控制模式为速度控制模式时,传感器模块106输出电机100的实际转速,电机100的 控制模式为位置控制模式时,传感器模块106输出电机100的实际位置。 0048 在步骤S106,A/D数据转换模块202将所述模拟信号量转换为数字信息。 0049 在步骤S108,补偿器模块204对所述数字信息进行补偿,并输出补偿数字信息。 0050 在本实施方式中,若双电机的控制方式为主从同步控制,且在速度控制模式下,则 补偿器模块204上对两电机100输出信号进行补偿,保证两电机输出信号同步。同步控制 的具体过程为,先将采集到的一电机实际转速与一电机输入设定转速做差,得到。
22、一电机受 负载扰动的输出信号,再根据另一电机的传递函数,估计一电机的扰动输出信号经过另一 电机时的幅值和相角损失,通过频率复合校正方法得到补偿器模块204的传递函数,对一 电机的扰动输出信号分别进行幅值和相角补偿;再将采集到的另一电机实际转速与另一电 机输入的设定转速做差,该差值与经过补偿后的一电机扰动输出信号相加后得到另一电机 的速度补偿信号。 0051 在本实施方式中,若双电机的控制方式为交叉耦合控制,且在速度控制模式下,则 补偿器模块204上对两电机输出信号进行补偿,保证两电机输出信号同步。将采集到的一 电机实际转速与一电机输入设定转速做差,得到一电机受负载扰动的输出信号,再根据另 一电。
23、机的传递函数估计一电机的扰动信号经过另一电机时的幅值和相角损失,通过改进后 的频率复合校正方法得到另一电机补偿器模块204的传递函数,对一电机输出信号分别进 行幅值和相角补偿;同时将采集到的另一电机实际转速与另一电机输入设定转速做差,得 到另一电机受负载扰动的输出信号,再根据一电机传递函数得到信号经过一电机时的幅值 和相角损失,通过改进后的频率复合校正方法得到一电机补偿器模块204的传递函数,对 另一电机输出信号分别进行幅值和相角补偿。 0052 在步骤S110,D/A数据转换模块206将所述补偿数字信息转换为补偿模拟信息。 0053 在步骤S112,D/A数据转换模块206将所述补偿模拟信息。
24、反馈给所述电机串级控 制部10,对所述电机100的运动进行修正。在本实施方式中,所述补偿模拟信息通过电机控 制模块102以及电机驱动模块104来实现对电机100的运动进行修正。 0054 请参阅图3,图3所示为图2中速度控制模式下步骤S108的具体步骤图。 0055 在步骤S1081,补偿器模块204在速度控制模式下获取所述电机100的实际转速。 0056 在步骤S1082,补偿器模块204对实际转速与设定转速求差以获取转速差值;以及 0057 在步骤S1083,补偿器模块204根据所述转速差值进行补偿,以获取补偿数字信 息。 说 明 书CN 102904496 A 5/5页 8 0058 请。
25、参阅图4,图4所示为图2中位置控制模式下步骤S108的具体步骤图。 0059 在步骤S1084,补偿器模块204在位置控制模式下获取所述电机的实际位置。 0060 在步骤S1085,补偿器模块204对实际转速与设定转速求差以获取位置差值;以及 0061 在步骤S1086,补偿器模块204根据所述位置差值进行补偿,以获取补偿数字信 息。 0062 本发明所提供的双电机同步控制系统及双电机同步控制的方法通过补偿器模块 204对实际转速与实际位置进行补偿,以实现对电机的运动修正,降低控制成本,提高运动 精度。 0063 虽然本发明参照当前的较佳实施方式进行了描述,但本领域的技术人员应能理 解,上述较佳实施方式仅用来说明本发明,并非用来限定本发明的保护范围,任何在本发明 的精神和原则范围之内,所做的任何修饰、等效替换、改进等,均应包含在本发明的权利保 护范围之内。 说 明 书CN 102904496 A 1/3页 9 图1 说 明 书 附 图CN 102904496 A 2/3页 10 图2 说 明 书 附 图CN 102904496 A 10 3/3页 11 图3 图4 说 明 书 附 图CN 102904496 A 11 。