CN111384881A - 快速消抖的高精度Collimator步进电机控制方法 - Google Patents

快速消抖的高精度Collimator步进电机控制方法 Download PDF

Info

Publication number
CN111384881A
CN111384881A CN202010142050.9A CN202010142050A CN111384881A CN 111384881 A CN111384881 A CN 111384881A CN 202010142050 A CN202010142050 A CN 202010142050A CN 111384881 A CN111384881 A CN 111384881A
Authority
CN
China
Prior art keywords
acceleration
stepping motor
stage
position information
displacement
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
CN202010142050.9A
Other languages
English (en)
Inventor
刘日平
李敏
黄振强
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Minfound Medical Systems Co Ltd
FMI Technologies Inc
Original Assignee
FMI Technologies Inc
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by FMI Technologies Inc filed Critical FMI Technologies Inc
Priority to CN202010142050.9A priority Critical patent/CN111384881A/zh
Publication of CN111384881A publication Critical patent/CN111384881A/zh
Pending legal-status Critical Current

Links

Images

Classifications

    • HELECTRICITY
    • H02GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02PCONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P8/00Arrangements for controlling dynamo-electric motors rotating step by step
    • H02P8/14Arrangements for controlling speed or speed and torque
    • HELECTRICITY
    • H01ELECTRIC ELEMENTS
    • H01JELECTRIC DISCHARGE TUBES OR DISCHARGE LAMPS
    • H01J35/00X-ray tubes
    • H01J35/02Details
    • H01J35/14Arrangements for concentrating, focusing, or directing the cathode ray

Landscapes

  • Engineering & Computer Science (AREA)
  • Power Engineering (AREA)
  • Control Of Stepping Motors (AREA)

Abstract

本发明涉及一种快速消抖的高精度Collimator步进电机控制方法,包括以下步骤:CPU接收和分析上位机发出的运动指令,获得初始参数;将步进电机的位移分为若干个阶段,根据初始参数得到每个阶段的位移;根据每个阶段的位移转换为各个阶段中步进电机所需运动的步数,并通过初始参数获得每一步的加速度和速度,CPU通过步进电机每一步的大小、加速度和速度计算得到步进电机动作每一步所需的时间长度;CPU计数器通过每一步所需的时间长度、加速度和速度控制步进电机动作;优点在于:加减速过程采用S型曲线加速,在加速和减速的过程中,加速度逐渐从最小值变化到最大值,保证力矩不突变,从而减小抖动幅值。

Description

快速消抖的高精度Collimator步进电机控制方法
技术领域
本发明涉及CT技术领域,尤其涉及一种快速消抖的高精度Collimator步进电机控制方法。
背景技术
CT***在放线过程中,X射线焦点在变化,需要Collimator(准直器)快速跟随焦点的变化而改变开缝的大小。普通的步进电机算法无法实现高速跟踪焦点(20ms调节一次),因步进电机在停止时,如果带有惯量负载,会有抖动问题存在。抖动的幅度与时间、减速度、机械负载惯量和机械体刚度相关,一般都在原地抖动约100ms。
基于此,本案由此提出。
发明内容
为解决上述问题,本发明的目的在于提供一种快速消抖的高精度Collimator步进电机控制方法,用于减小步进电机的振动幅度和振动时间。
为了实现上述目的,本发明的技术方案如下:
一种快速消抖的高精度Collimator步进电机控制方法,其特征在于,包括以下步骤:
S10:CPU接收和分析上位机发出的运动指令,获得初始参数;
S20:将步进电机的位移分为若干个阶段,根据初始参数得到每个阶段的位移;
S30:根据每个阶段的位移转换为各个阶段中步进电机所需运动的步数,并通过初始参数获得每一步的加速度和速度,CPU通过步进电机每一步的大小、加速度和速度计算得到步进电机动作每一步所需的时间长度;
S40:CPU计数器通过每一步所需的时间长度、加速度和速度控制步进电机动作。
进一步的,所述初始参数包括加速系数ka、目标加速度am、目标速度vm及目标位移Sm,且将步进电机分为加加速段a、匀加速段b、减加速段c、匀速段d、加减速段e、匀减速段f和减减速段g七个阶段;
所述S20中包括以下判断步骤:
S21:若满足
Figure BDA0002399445500000021
Figure BDA0002399445500000022
当Sm≥Sa+Sb+Sc+Se+Sf+Sg,则直接进入步骤S30,
当Sa+Sc+Se+Sg≤Sm<Sa+Sb+Sc+Se+Sf+Sg,则取Sd=0,并重新计算Sb和Sf后进入步骤S30,重新计算的
Figure BDA0002399445500000023
当Sm<Sa+Sc+Se+Sg,则取Sb=Sf=Sd=0,并重新计算Sa、Sc、Se、Sg后进入步骤S30,重新计算的
Figure BDA0002399445500000024
若不满足
Figure BDA0002399445500000025
Figure BDA0002399445500000026
当Sm≥Sa+Sc+Se+Sg,则直接进入步骤S30,
当Sm<Sa+Sc+Se+Sg,则取Sb=Sf=Sd=0,并重新计算Sa、Sc、Se、Sg后进入步骤S30,重新计算的
Figure BDA0002399445500000031
其中Sa、Sb、Sc、Sd、Se、Sf、Sg为各个阶段的位移值。
进一步的,所述步骤S30包括以下步骤:
S31:根据各阶段位移确定步进电机在各个阶段所需运动的步数和总步数;
S32:使能TIMx匹配中断,此时TIMx寄存器内的步数i=0;
S33:进入TIMx中断,并记录进入中断的次数;
S34:若进入中断的次数为偶数,则脉冲脚拉至高电平,TIMx寄存器内的步数i=i+1,并回到步骤S33;若进入中断的次数为奇数,则脉冲脚拉至低电平,并进入步骤S35;
S35:若i≤总步数,则加加速段a和减减速段g的加速度为:a(i+1)=ai+ka*Ti,匀加速段b和匀减速段f的加速度为:a(i+1)=ai,减加速段c和加减速段e的加速度为:a(i+1)=ai-ka*Ti,匀速段d的加速度为:a(i+1)=0,并进入步骤S36,其中ai表示第i步时,步进电机所需的加速度;若i>总步数,则关闭TIMx中断,并使TIMx寄存器内的步数i=0;
S36:计算第i+1步的速度v(i+1)=vi+ai*Ti;计算第i+1步的时间,T(i+1)=步距脚/(细分*vi),其中,步距脚和细分为步进电机参数值,为常数;
S37:使TIMx寄存器内的步数i=i+1,回到步骤S33。
进一步的,包括步骤S50:在运动结束瞬间进行振动抑制,所述振动抑制包括以下步骤:
S51:步进电机编码器采集模块获取当前位置信息,并将位置信息反馈给CPU;
S52:CPU将反馈的位置信息与目标位置信息进行对比,若不在目标位置则进入步骤S53,否则进入步骤S54;
S53:计算补偿量,补偿量为当前位置与目标位置的差值,根据补偿量对步进电机位置进行调节,调节完毕后回到S51;
S54:编码器再次获取当前步进电机的位置信息,并将位置信息反馈给CPU,CPU将反馈的位置信息与目标位置信息进行对比,若不在目标位置,则进入步骤S53,若在目标位置,则结束抑制调节。
本发明的优点在于:
1.加减速过程采用S型曲线加速,在加速和减速的过程中,加速度逐渐从最小值变化到最大值,保证力矩不突变,从而减小抖动幅值;
2.在停止时,将采集到的编码器值与目标位置进行比较,启动反向调节以抑制振动,减少抖动时间。
附图说明
图1为实施例中满足
Figure BDA0002399445500000041
且Sm≥Sa+Sb+Sc+Se+Sf+Sg时的加速度、速度及位移曲线示意图;
图2(a)为实施例中满足
Figure BDA0002399445500000042
且Sa+Sc+Se+Sg≤Sm<Sa+Sb+Sc+Se+Sf+Sg时的加速度曲线示意图;
图2(b)为实施例中满足
Figure BDA0002399445500000043
且Sm<Sa+Sc+Se+Sg时的加速度曲线示意图;
图3(a)为实施例中Sm≥Sa+Sc+Se+Sg且不满足
Figure BDA0002399445500000044
时的加速度曲线示意图;
图3(b)为实施例中Sm<Sa+Sc+Se+Sg且不满足
Figure BDA0002399445500000045
时的加速度曲线示意图;
图4为实施例中CPU控制步进电机进行S型曲线加速时的过程示意图;
图5为弹簧负载时的示意图;
图6为实施例中步进电机停止后的振动抑制流程示意图;
图7为本实施例增加抑制流程后的总的控制流程示意图。
具体实施方式
以下结合实施例对本发明作进一步详细描述。
本实施例提出一种快速消抖的高精度Collimator步进电机控制方法,包括以下步骤:
S10:CPU接收和分析上位机发出的运动指令,获得初始参数,初始参数包括加速系数ka、目标加速度am、目标速度vm、启动速度vs、停止速度ve、启动加速度as和停止加速度ae,确定上述参数后,就可确定一条唯一的S型曲线,而步进电机的启动速度vs、停止速度ve、启动加速度as和停止加速度ae均为0,所以在控制时不必在计算;
S20:将步进电机的位移分为分为加加速段a、匀加速段b、减加速段c、匀速段d、加减速段e、匀减速段f和减减速段g七个阶段,根据初始参数得到每个阶段的位移,计算过程包括以下步骤:
S21:若满足
Figure BDA0002399445500000051
(步进电机先达到最大速度),则
Figure BDA0002399445500000052
当Sm≥Sa+Sb+Sc+Se+Sf+Sg时,式(1)中各阶段计算位移为最终结果,加速度、速度及位移曲线如图1所示,根据计算结果直接进入步骤S30,
当Sa+Sc+Se+Sg≤Sm<Sa+Sb+Sc+Se+Sf+Sg时,则取Sd=0,并重新计算Sb和Sf后进入步骤S30,重新计算的
Figure BDA0002399445500000061
图2(a)为此时的加速度曲线示意图,
当Sm<Sa+Sc+Se+Sg时,则取Sb=Sf=Sd=0,并重新计算Sa、Sc、Se、Sg后进入步骤S30,重新计算的
Figure BDA0002399445500000062
如图2(b)为此时的加速度曲线示意图;
若不满足
Figure BDA0002399445500000063
(步进电机先达到最大加速度),则
Figure BDA0002399445500000064
当Sm≥Sa+Sc+Se+Sg时,则式(2)中各阶段计算位移为最终结果,加速度曲线如图3(a)所示,根据最终计算结果直接进入步骤S30,
当Sm<Sa+Sc+Se+Sg时,则取Sb=Sf=Sd=0,并重新计算Sa、Sc、Se、Sg后进入步骤S30,重新计算的
Figure BDA0002399445500000065
加速度曲线如图3(b)所示;步骤S20中的Sa、Sb、Sc、Sd、Se、Sf、Sg为各个阶段的位移值;
S30:根据每个阶段的位移转换为各个阶段中步进电机所需运动的步数,并通过初始参数获得每一步的加速度和速度,CPU通过步进电机每一步的大小、加速度和速度计算得到步进电机动作每一步所需的时间长度,如图4所示,S30包括以下步骤:
S31:根据各阶段位移确定步进电机在各个阶段所需运动的步数和总步数;
S32:使能TIMx匹配中断,此时TIMx寄存器内的步数i=0;
S33:进入TIMx中断,并记录进入中断的次数;
S34:若进入中断的次数为偶数,则脉冲脚拉至高电平,TIMx寄存器内的步数i=i+1,并回到步骤S33;若进入中断的次数为奇数,则脉冲脚拉至低电平,并进入步骤S35,脉冲脚在步进电机不动作时为高电平,一个完整的脉冲分为等时间的高电平和低电平两个阶段,在脉冲脚拉至高电平的时候,立即给TIMx的匹配中断寄存器赋值,使下次进入中断的时间为该步计算的脉冲时间的一半。当脉冲脚拉至低电平的时候,则说明脉冲已经发送了一半,此时需要立即计算下一个脉冲的时间,采用迭代法在各个定时器匹配中断中分别计算下一步定时器的匹配值可大大减少S型运动曲线的计算量;
S35:若i≤总步数,则加加速段a和减减速段g的加速度为:a(i+1)=ai+ka*Ti,匀加速段b和匀减速段f的加速度为:a(i+1)=ai,减加速段c和加减速段e的加速度为:a(i+1)=ai-ka*Ti,匀速段d的加速度为:a(i+1)=0,并进入步骤S36,其中ai表示第i步时,步进电机所需的加速度;若i>总步数,则关闭TIMx中断,并使TIMx寄存器内的步数i=0;
S36:计算第i+1步的速度v(i+1)=vi+ai*Ti;计算第i+1步的时间,T(i+1)=步距脚/(细分*vi),其中,步距脚和细分为步进电机参数值,为常数;
S37:使TIMx寄存器内的步数i=i+1,回到步骤S33;
S40:CPU计数器通过每一步所需的时间长度、加速度和速度控制步进电机动作。
加减速过程采用S型曲线加速,在加速和减速的过程中,加速度逐渐从最小值变化到最大值,保证力矩不突变,从而减小抖动幅值,但当步进电机驱动回旋体运动,停止的瞬间,由于转动惯量的存在,会在步进电机A/B相形成的力的夹角上进行抖动。如图5所示,其原理同一根弹簧挂载一个重物后,重物的上下振动同理,当负载从某一高度落下时,必定会上下振动。为解决该缺陷,本实施例在步进电机停止时,进行了振动抑制,以减少抖动时间,即负载在惯性运动时,给予一个反方向的作用力,使其反方向调节,从而快速停止振动,振动抑制流程如图6所示,包括以下步骤:
S51:步进电机编码器采集模块获取当前位置信息,并将位置信息反馈给CPU;
S52:CPU将反馈的位置信息与目标位置信息进行对比,若不在目标位置则进入步骤S53,否则进入步骤S54;
S53:计算补偿量,补偿量为当前位置与目标位置的差值,根据补偿量对步进电机位置进行调节,调节完毕后回到S51;
S54:编码器再次获取当前步进电机的位置信息,并将位置信息反馈给CPU,CPU将反馈的位置信息与目标位置信息进行对比,若不在目标位置,则进入步骤S53,若在目标位置,则结束抑制调节。
如图7所示,为增加抑制流程后,本实施例的总的控制流程示意图。
上述实施例仅用于解释说明本发明的构思,而非对本发明权利保护的限定,凡利用此构思对本发明进行非实质性的改动,均应落入本发明的保护范围。

Claims (4)

1.一种快速消抖的高精度Collimator步进电机控制方法,其特征在于,包括以下步骤:
S10:CPU接收和分析上位机发出的运动指令,获得初始参数;
S20:将步进电机的位移分为若干个阶段,根据初始参数得到每个阶段的位移;
S30:根据每个阶段的位移转换为各个阶段中步进电机所需运动的步数,并通过初始参数获得每一步的加速度和速度,CPU通过步进电机每一步的大小、加速度和速度计算得到步进电机动作每一步所需的时间长度;
S40:CPU计数器通过每一步所需的时间长度、加速度和速度控制步进电机动作。
2.如权利要求1所述的一种快速消抖的高精度Collimator步进电机控制方法,其特征在于:所述初始参数包括加速系数ka、目标加速度am、目标速度vm及目标位移Sm,且将步进电机分为加加速段a、匀加速段b、减加速段c、匀速段d、加减速段e、匀减速段f和减减速段g七个阶段;
所述S20中包括以下判断步骤:
S21:若满足
Figure FDA0002399445490000012
Figure FDA0002399445490000013
当Sm≥Sa+Sb+Sc+Se+Sf+Sg,则直接进入步骤S30,
当Sa+Sc+Se+Sg≤Sm<Sa+Sb+Sc+Se+Sf+Sg,则取Sd=0,并重新计算Sb和Sf后进入步骤S30,重新计算的
Figure FDA0002399445490000015
当Sm<Sa+Sc+Se+Sg,则取Sb=Sf=Sd=0,并重新计算Sa、Sc、Se、Sg后进入步骤S30,重新计算的
Figure FDA0002399445490000021
若不满足
Figure FDA0002399445490000022
Figure FDA0002399445490000023
当Sm≥Sa+Sc+Se+Sg,则直接进入步骤S30,
当Sm<Sa+Sc+Se+Sg,则取Sb=Sf=Sd=0,并重新计算Sa、Sc、Se、Sg后进入步骤S30,重新计算的
Figure FDA0002399445490000024
其中Sa、Sb、Sc、Sd、Se、Sf、Sg为各个阶段的位移值。
3.如权利要求2所述的一种快速消抖的高精度Collimator步进电机控制方法,其特征在于:所述步骤S30包括以下步骤:
S31:根据各阶段位移确定步进电机在各个阶段所需运动的步数和总步数;
S32:使能TIMx匹配中断,此时TIMx寄存器内的步数i=0;
S33:进入TIMx中断,并记录进入中断的次数;
S34:若进入中断的次数为偶数,则脉冲脚拉至高电平,TIMx寄存器内的步数i=i+1,并回到步骤S33;若进入中断的次数为奇数,则脉冲脚拉至低电平,并进入步骤S35;
S35:若i≤总步数,则加加速段a和减减速段g的加速度为:a(i+1)=ai+ka*Ti,匀加速段b和匀减速段f的加速度为:a(i+1)=ai,减加速段c和加减速段e的加速度为:a(i+1)=ai-ka*Ti,匀速段d的加速度为:a(i+1)=0,并进入步骤S36,其中ai表示第i步时,步进电机所需的加速度;若i>总步数,则关闭TIMx中断,并使TIMx寄存器内的步数i=0;
S36:计算第i+1步的速度v(i+1)=vi+ai*Ti;计算第i+1步的时间,T(i+1)=步距脚/(细分*vi),其中,步距脚和细分为步进电机参数值,为常数;
S37:使TIMx寄存器内的步数i=i+1,回到步骤S33。
4.如权利要求1所述的一种快速消抖的高精度Collimator步进电机控制方法,其特征在于:包括步骤S50:在运动结束瞬间进行振动抑制,所述振动抑制包括以下步骤:
S51:步进电机编码器采集模块获取当前位置信息,并将位置信息反馈给CPU;
S52:CPU将反馈的位置信息与目标位置信息进行对比,若不在目标位置则进入步骤S53,否则进入步骤S54;
S53:计算补偿量,补偿量为当前位置与目标位置的差值,根据补偿量对步进电机位置进行调节,调节完毕后回到S51;
S54:编码器再次获取当前步进电机的位置信息,并将位置信息反馈给CPU,CPU将反馈的位置信息与目标位置信息进行对比,若不在目标位置,则进入步骤S53,若在目标位置,则结束抑制调节。
CN202010142050.9A 2020-03-04 2020-03-04 快速消抖的高精度Collimator步进电机控制方法 Pending CN111384881A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010142050.9A CN111384881A (zh) 2020-03-04 2020-03-04 快速消抖的高精度Collimator步进电机控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010142050.9A CN111384881A (zh) 2020-03-04 2020-03-04 快速消抖的高精度Collimator步进电机控制方法

Publications (1)

Publication Number Publication Date
CN111384881A true CN111384881A (zh) 2020-07-07

Family

ID=71217011

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010142050.9A Pending CN111384881A (zh) 2020-03-04 2020-03-04 快速消抖的高精度Collimator步进电机控制方法

Country Status (1)

Country Link
CN (1) CN111384881A (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112532146A (zh) * 2020-11-16 2021-03-19 深圳市科曼医疗设备有限公司 加减速运动控制方法、装置、设备和介质

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105511510A (zh) * 2016-01-05 2016-04-20 北京石油化工学院 仓储安全距离的扫描监测***及其定位控制方法
CN107070329B (zh) * 2017-02-20 2019-06-11 武汉科技大学 S型运行曲线计算方法以及步进电机旋转控制方法
CN109991932A (zh) * 2017-12-29 2019-07-09 沈阳新松机器人自动化股份有限公司 一种物流搬运设备s曲线加减速速度规划与控制方法

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105511510A (zh) * 2016-01-05 2016-04-20 北京石油化工学院 仓储安全距离的扫描监测***及其定位控制方法
CN107070329B (zh) * 2017-02-20 2019-06-11 武汉科技大学 S型运行曲线计算方法以及步进电机旋转控制方法
CN109991932A (zh) * 2017-12-29 2019-07-09 沈阳新松机器人自动化股份有限公司 一种物流搬运设备s曲线加减速速度规划与控制方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
祁超等: "精密转台S曲线轨迹规划及高精度控制", 《光学精密工程》 *
陈祖霖等: "步进电机S曲线调速控制研究", 《福州大学学报( 自然科学版)》 *

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112532146A (zh) * 2020-11-16 2021-03-19 深圳市科曼医疗设备有限公司 加减速运动控制方法、装置、设备和介质
WO2022099788A1 (zh) * 2020-11-16 2022-05-19 深圳市科曼医疗设备有限公司 加减速运动控制方法、装置、设备和介质
CN112532146B (zh) * 2020-11-16 2023-02-28 深圳市科曼医疗设备有限公司 加减速运动控制方法、装置、设备和介质

Similar Documents

Publication Publication Date Title
JP5183399B2 (ja) 数値制御装置
CN111240370B (zh) 云台的位置校正方法、装置、***及存储介质
JP5860755B2 (ja) 電動機制御装置及びその自動調整法
JP3129622B2 (ja) フルクローズド・ループ方式における象限突起補正方法
CN106060380A (zh) 一种联动相机控制***及控制方法
US10564387B2 (en) Lens drive device and lens drive method
WO1984002590A1 (en) Adaptive feedforward servo system
CN111384881A (zh) 快速消抖的高精度Collimator步进电机控制方法
CN113518860A (zh) 用于运行风能设备的方法、调节器结构、风能设备和风电场
CN110248082A (zh) 一种规划摄像机运动控制曲线的方法及装置
US20150205277A1 (en) Drive controller, driving system, and drive control method
CN107040175A (zh) 音圈电机启动控制方法及装置、摄像头模组
US9606517B2 (en) Actuator control method and actuator control device
CN112083649B (zh) 一种电力机车恒速控制方法、装置及设备
CN115566941A (zh) 一种步进电机的s型加速度曲线控制方法
EP3076260A1 (en) Device and method for assisting in design improvement work for mechanical device
US20020113566A1 (en) Method and actuation control for stopping an electrical drive, by means of closed-loop position control, in a predetermined nominal position
CN107991651B (zh) 一种雷达伺服***的预定角度自适应步进控制方法
US9558897B2 (en) Actuator control method and actuator control device
CN110018634B (zh) 一种提升控制力矩陀螺带宽的自适应框架控制***及方法
CN111371378B (zh) 速度控制的方法和装置
US7280899B2 (en) S-type smooth command generating method and means thereof
JP5925066B2 (ja) モータ駆動制御装置
JP6886148B2 (ja) アクティブマスダンパおよびアクティブマスダンパの制御装置
CN115437238B (zh) 直流电机驱动单杆***的变长度pd型迭代学习控制方法

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
RJ01 Rejection of invention patent application after publication
RJ01 Rejection of invention patent application after publication

Application publication date: 20200707