CN110051382B - 超声探头的步进电机控制方法、存储介质以及超声探头 - Google Patents

超声探头的步进电机控制方法、存储介质以及超声探头 Download PDF

Info

Publication number
CN110051382B
CN110051382B CN201910217671.6A CN201910217671A CN110051382B CN 110051382 B CN110051382 B CN 110051382B CN 201910217671 A CN201910217671 A CN 201910217671A CN 110051382 B CN110051382 B CN 110051382B
Authority
CN
China
Prior art keywords
stepping motor
formula
ultrasonic probe
calculation
sub
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.)
Active
Application number
CN201910217671.6A
Other languages
English (en)
Other versions
CN110051382A (zh
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.)
Sonoscape Medical Corp
Original Assignee
Sonoscape Medical Corp
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 Sonoscape Medical Corp filed Critical Sonoscape Medical Corp
Priority to CN201910217671.6A priority Critical patent/CN110051382B/zh
Publication of CN110051382A publication Critical patent/CN110051382A/zh
Application granted granted Critical
Publication of CN110051382B publication Critical patent/CN110051382B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B8/00Diagnosis using ultrasonic, sonic or infrasonic waves
    • A61B8/44Constructional features of the ultrasonic, sonic or infrasonic diagnostic device
    • A61B8/4444Constructional features of the ultrasonic, sonic or infrasonic diagnostic device related to the probe
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B8/00Diagnosis using ultrasonic, sonic or infrasonic waves
    • A61B8/46Ultrasonic, sonic or infrasonic diagnostic devices with special arrangements for interfacing with the operator or the patient
    • A61B8/461Displaying means of special interest
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B8/00Diagnosis using ultrasonic, sonic or infrasonic waves
    • A61B8/48Diagnostic techniques
    • A61B8/483Diagnostic techniques involving the acquisition of a 3D volume of data
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B8/00Diagnosis using ultrasonic, sonic or infrasonic waves
    • A61B8/52Devices using data or image processing specially adapted for diagnosis using ultrasonic, sonic or infrasonic waves
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B8/00Diagnosis using ultrasonic, sonic or infrasonic waves
    • A61B8/54Control of the diagnostic device

Landscapes

  • Health & Medical Sciences (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Engineering & Computer Science (AREA)
  • Biomedical Technology (AREA)
  • Medical Informatics (AREA)
  • Pathology (AREA)
  • Radiology & Medical Imaging (AREA)
  • Biophysics (AREA)
  • Physics & Mathematics (AREA)
  • Heart & Thoracic Surgery (AREA)
  • Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
  • Molecular Biology (AREA)
  • Surgery (AREA)
  • Animal Behavior & Ethology (AREA)
  • General Health & Medical Sciences (AREA)
  • Public Health (AREA)
  • Veterinary Medicine (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Ultra Sonic Daignosis Equipment (AREA)

Abstract

超声探头的步进电机控制方法、存储介质以及超声探头,方法应用于步进电机的马达控制器中,包括:获取可变参数,其中,步进电机的运行速度计算公式由第一子公式和第二子公式组合得到,其中,第一子公式的计算结果随超声探头的扫描参数变化而变化,第一子公式的计算结果作为可变参数,第二子公式的计算结果与超声探头的运行时刻之间一一对应;从马达控制器存储的预设映射数据中调取与当前步进电机的运行时刻相匹配的固定计算因子,第二子公式的计算结果作为所述固定计算因子;将固定计算因子和可变参数代入预设计算公式中,计算得到当前步进电机的运行时刻所对应的步进电机的运行速度。降低了超声主机与步进电机的马达控制器之间的数据传输量。

Description

超声探头的步进电机控制方法、存储介质以及超声探头
技术领域
本发明涉及电机控制系统技术领域,具体涉及一种超声探头的步进电机控制方法、存储介质以及超声探头。
背景技术
4D超声技术就是采用3D超声图像加上时间维度参数,能够实时获取三维超声图像,因此也被称作实时三维技术。同其他超声诊断技术相比,4D超声可以实时观察和获取被测组织的实时活动图像,为临床超声诊断提供了更丰富的影像信息和诊断依据。
4D超声技术的实现离不开4D超声探头,主流的4D超声探头主要包括步进电机、超声换能器和传动装置。3D/4D超声扫描,需要通过马达控制器控制步进电机来回匀速运动,带动超声换能器连续均匀的对被测部位进行切片扫描,然后进行三维重建得到3D/4D超声图像。为了准确获取3D/4D超声图像,在4D超声探头进行超声扫描时,必须精准地控制换能器的运动速度和摆动角度。
现有的4D超声探头马达控制器(简称4D马达控制器)通常采用梯形控制曲线对探头内部的步进电机进行驱动控制。控制曲线是一组能够控制步进电机速度的控制参数,控制器根据控制曲线来实现4D探头正向加速、正向匀速、正向减速、反向加速、反向匀速和反向减速的往复控制过程。步进电机控制曲线的计算和生成,通常采用以下两种方案:①在超声主机CPU中进行步进电机控制曲线的计算和生成,然后通过UART、SPI或其他通讯接口将控制曲线下载到4D马达控制器;②在4D马达控制器中完成控制曲线的计算过程,这种方法需要4D马达控制器的微处理器能够支持乘法、开方等复杂运算,应用较少。
在现有技术方案中,在使用超声探头时,在超声主机CPU中进行步进电机控制曲线的计算和生成,然后通过UART、SPI或其他通讯接口将控制曲线下载到4D马达控制器。由于控制曲线数据量比较大,下载需要很长时间,且每次切换参数都需要重新下载,影响用户体验。
发明内容
有鉴于此,本发明实施例提供一种超声探头的步进电机控制方法、存储介质以及超声探头,以解决现有技术中超声探头的步进电机控制曲线在超声主机CPU中进行计算和生成,将其下载到马达控制器中需要很长时间的问题。
为实现上述目的,本发明实施例提供如下技术方案:
一种超声探头的步进电机控制方法,应用于步进电机的马达控制器中,方法包括:
获取可变参数,其中,所述步进电机的运行速度计算公式中由第一子公式和第二子公式组合得到,其中,所述第一子公式的计算结果随超声探头的扫描参数变化而变化,所述第一子公式的计算结果作为所述可变参数,所述第二子公式的计算结果与所述超声探头的运行时刻之间一一对应;
从马达控制器存储的预设映射数据中调取与当前步进电机的运行时刻相匹配的固定计算因子,所述预设映射数据中存储有与所述当前步进电机的运行时刻相匹配的固定计算因子,所述第二子公式的计算结果作为所述固定计算因子;
将所述固定计算因子和可变参数代入预设计算公式中,计算得到所述当前步进电机的运行时刻所对应的步进电机的运行速度。
优选的,上述超声探头的步进电机控制方法中,所述超声探头为线性传动结构。
优选的,上述超声探头的步进电机控制方法中,
所述步进电机的运行速度计算公式为:
Figure GDA0002076898650000021
其中,所述△tn+1为步进电机相邻两微步的间隔时间,表示线性传动结构的超声探头的步进电机的运行速度,所述n表示所述步进电机运行的脉冲个数,所述Freq为所述马达控制器的时钟频率,所述aω为步进电机加速和减速过程中的加速度,所述k为步进电机每运行一微步对应的电机传动杆的步距角。
优选的,上述超声探头的步进电机控制方法中,所述可变参数为:
Figure GDA0002076898650000031
所述固定计算因子为:
Figure GDA0002076898650000032
所述将所述固定计算因子和可变参数代入预设计算公式中,计算得到所述当前步进电机的运行时刻所对应的步进电机的运行速度,包括:
将所述固定计算因子和可变参数之积作为当前步进电机的运行时刻所对应的步进电机的运行速度。
优选的,上述超声探头的步进电机控制方法中,所述超声探头为非线性传动结构。
优选的,上述超声探头的步进电机控制方法中,所述步进电机的运行速度计算公式为:
Figure GDA0002076898650000033
其中,△t为步进电机相邻两微步的间隔时间,表示非线性传动结构的超声探头的步进电机的运行速度,所述k为步进电机每运行一微步对应的电机传动杆的步距角,所述Ang为探头芯部单向摆动一次的角度,所述Frm为探头芯部的摆动频率,所述α为探头的偏转角,所述d和R为预设数值,所述γ=β-α,所述β=arctan(R*sinα/(R*cosα-d))。
优选的,上述超声探头的步进电机控制方法中,所述可变参数为:
Figure GDA0002076898650000041
所述固定计算因子为:
Figure GDA0002076898650000042
所述将所述固定计算因子和可变参数代入预设计算公式中,计算得到所述当前步进电机的运行时刻所对应的步进电机的运行速度,包括:
将所述固定计算因子和可变参数之积作为当前步进电机的运行时刻所对应的步进电机的运行速度。
一种存储介质,所述存储介质上存储有计算机程序,所述计算机程序被处理器执行时,实现如权利要求1至7中任一权利要求所述的超声探头的步进电机控制方法。
一种超声探头,包括步进电机、步进电机控制器、超声换能器和传动装置,所述传动装置连接所述步进电机和所述超声换能器,所述步进电机控制器内存储有计算机程序,所述计算机程序被所述步进电机控制器执行时,实现权利要求1至7任意一项权利要求所述的超声探头的步进电机控制方法。
基于上述技术方案,由于部分计算过程在步进电机的马达控制器端进行,因此可以达到本发明实施例提供的降低超声主机与步进电机控制器之间数据传输量的目的。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据提供的附图获得其他的附图。
图1为非线性探头传动结构示意图;
图2为乘法运算定点化处理方案;
图3为本申请实施例提供的超声探头的步进电机控制方法的流程示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
对于线性传动的4D超声探头而言,探头换能器的摆动与步进电机转动速度呈线性关系。本方案使用梯形控制曲线完成4D探头正向匀加速、正向匀速、正向匀减速、反向匀加速、反向匀速和反向匀减速的往复控制过程。对于线性传动的探头,加速过程较匀速过程的控制复杂,假设加速和减速过程的加速度为aω,换能器转过角位移为
Figure GDA0002076898650000051
则从静止开始加速的过程中,换能器的角位移满足:
Figure GDA0002076898650000052
其中,所述t指的是进入加速阶段的时长;
由于超声换能器的角位移与步进电机运动的微步数一一对应,因而上述公式(1)可写成:
Figure GDA0002076898650000053
式中,
Figure GDA0002076898650000054
表示换能器在步进电机运行第n个微步后转过的总角度;tn表示电机运行第n个脉冲的时刻;k表示换能器步距角,所述k为固定值,指的是步进电机每运行一微步对应的电机传动杆的步距角。因而,第n+1个与第n个微步的时间间隔满足:
Figure GDA0002076898650000055
步进电机相邻两微步的时间间隔Δtn+1即线性传动结构的超声探头的步进电机的运行速度,对应着4D超声换能器的控制速度。因此4D马达控制器的控制曲线实际上就是步进电机的微步时间控制曲线。在马达控制FPGA中,Δtn+1需要量化成时钟周期的个数,即乘以FPGA工作的时钟频率Freq:
Figure GDA0002076898650000061
传统的4D超声探头控制方案通常将式(4)的运算放在超声主机CPU中完成,然后根据步进电机的微步数产生n个数据的控制曲线下载到4D马达控制器。上述公式(4)中包含开根号、除法和乘法等复杂运算,而且当电机微步数n很大时,控制曲线的计算和下载需要耗费很长时间。另外一种做法是将公式(4)直接放到马达控制FPGA中实现,但FPGA需要耗费很多的逻辑资源去实现根号运算和除法运算,会明显增加硬件成本和逻辑设计复杂度。
申请人经过研究发现,对于所有线性传动的4D超声探头来说,公式(4)中
Figure GDA0002076898650000062
的运算是一样的,而且不受4D超声扫描用户参数的影响。因此本发明将公式(4)的结果分为加速度系数κa和微步间隔系数Δτn+1两部分:
Figure GDA0002076898650000063
Figure GDA0002076898650000064
其中,加速度系数κa随4D扫描参数变化而变化,作为可变参数放在超声主机CPU中实时计算,并将其量化为32bit的无符号整数(u32),然后下载到马达控制FPGA。可有效减少参数计算次数和下载数量。
所述微步间隔系数Δτn+1作为固定计算因子,可离线计算得到,将计算结果量化为16bit的无符号小数(u0.16),作为查找表初始化存储在FPGA内部RAM中,其中,所述公式(6)中的n可以大于预设值,只要n的值满足所有探头中的最大加速步数即可。
可见,上述公式中,可变参数为32bit的无符号整数(u32),固定计算因子为大于0而小于1的无符号小数(u0.16),可极大的简化马达FPGA的运算量,当所述加速度系数κa和微步间隔系数Δτn+1加载到马达FPGA后,马达FPGA只使用一个乘法器即可生成步进电机速度控制曲线。
对于非线性传动的4D超声探头而言,非线性传动的4D超声探头的驱动示意图如图1所示,图1中DF为半径为R的弧线的切线,DE为以AD为半径的圆的切线,CD与AB垂直,实线圆弧1为换能器的运动轨迹,O为运动轨迹的圆心(虚拟),A为传动杆转轴位置,AD表示超声换能器传动杆。换能器圆弧轨迹半径为固定值R,OA之间的距离为固定值d。由于运动轨迹和马达转轴位置固定,AD杆的长度在探头芯部摆动过程中是可变的,这就导致了探头芯部运动速度与马达转动速度之间呈非线性关系。
非线性探头在实际应用中,要求探头芯部摆动是匀速的,对应步进电机的转动速度就是非匀速的,因此电机控制曲线的计算会比较复杂。
假设vDF为探头芯部匀速摆动的线速度,则马达转动(圆心A)的角速度为
ω=vDE/AD=vDF*cosγ/AD (7)
由于AD的长度和cosγ的值是随α角度变化而不断变化的,AD的长度和cosγ的值与偏转角度α之间存在预设的映射关系,由公式(7)可知马达转动角速度ω的值取决于探头运动速度vDF和偏转角度α。
所述探头运动速度vDF由探头(圆心O)摆动角度Ang(探头芯部单向摆动一次的角度)和探头摆动帧频Frm(探头芯部每秒钟来回摆动的次数,每秒钟来回摆动Ang的次数)决定,即
vDF=ω0*R=Ang*Frm*R (8)
又由于
CD=OD*sin∠COD=R sinα (9)
AC=OD*cos∠COD-OA=R cosα-d (10)
Figure GDA0002076898650000081
β=arctan(CD/AC)=arctan(R sinα/(R cosα-d)) (12)
γ=∠EDF=∠ADO=∠CAD-∠COD=β-α (13)
由(6)~(11)式可得,马达转动角速度(圆心A)为
Figure GDA0002076898650000082
由公式(12)、(13)、(14)可知,对于同一型号的非线性传动的4D超声探头(R和d固定不变),马达转动角速度ω的值与摆动角度Ang、探头摆动帧频Frm和换能器偏转角度α有关。
假设电机传动杆AD的步距角为k(步进电机每运行一微步对应的电机传动杆的步距角),马达控制器时钟频率为Freq,则步进电机相邻两微步的间隔时间为
Figure GDA0002076898650000083
在公式(15)给出的公式中,所述F指代的是马达控制器时钟频率为Freq,由(15)式可知,在摆动角度Ang和探头摆动帧频Frm设定(探头匀速摆动速度确定)的情况下,微步间隔时间只与偏转角度α(圆心O)有关。
Figure GDA0002076898650000084
Δt=fac1*fac2 (16)
由于k和Freq为常量,参数fac1的值取决于摆动角度Ang和探头摆动帧频Frm;由于R和d固定不变,参数fac2的值便只与偏转角度α有关。
对于同一型号的非线性传动的4D超声探头而言,偏转角度α的取值范围是确定的,由(12)式可知传动杆AD的摆动范围为(-βmax,βmax),在此范围内步进电机可运行的总步数N也是确定的:
N=2*floor(βmax/k) (17)
上述公式中,所述floor()是向下取整函数,表示向下取整,当摆动角度Ang的值设到最大时(Ang_max=2*αmax),步进电机步数达到最大值N,即传动杆AD的摆动范围(-βmax,βmax)步进电机需要运行N个微步。根据(12)式,可计算得到步进电机在(-βmax,βmax)内的每一微步对应(-αmax,αmax)范围内的α角度值,从而可确定每一微步对应的fac2参数值。由此可得到一个深度为N的fac2参数表,且对于同一探头fac2参数表是固定不变的。
当α=0时,β=0,γ=β-α=0,参数fac2具有最小值fac2=1-d/R>0;又
Figure GDA0002076898650000091
所以参数fac2的取值恒为(0,1)范围内的小数。
马达控制FPGA对非线性传动的4D超声探头的驱动控制主要通过步进电机的微步间隔时间表来实现。根据以上原理分析,非线性传动的4D超声探头的微步间隔时间与摆动角度Ang、探头摆动帧频Frm和换能器偏转角度α有关。按照(16)式将微步间隔时间参数分解为两部分,fac1使用32bit无符号整数(u32)表示,作为可变参数由超声主机CPU根据用户设定的摆动角度Ang和探头摆动Frm(4D帧频)进行实时计算,得到fac1,并将其量化为32bit无符号整数(u32),然后下载到马达控制FPGA。fac2作为固定计算因子可离线计算(使用Matlab离线计算)得到,将计算结果量化为16bit的无符号小数(u0.16),生成fac2参数表fac2。
对于同一型号的非线性传动的4D超声探头,fac2参数表是固定不变的。因此可根据探头型号差别,将超声主机所支持的所有非线性传动的4D超声探头的fac2参数表做成查找表初始化到马达控制FPGA内部RAM中,在使用时,可查表得到fac2的值;也可以选择非线性传动的4D超声探头接入主机识别后,将对应的fac2参数表下载到马达控制FPGA(每次选择探头型号后,只需要下载一次,切换4D参数不需要重新下载)。
由上述方案可见,对于4D马达控制FPGA来说,非线性4D超声探头的控制曲线计算方法与线性4D探头一样,只使用一个乘法器即可计算出步进电机的微步间隔时间,如图2所示。
通过CPU下载的可变参数和FPGA固定计算因子查找表,经过简单计算即可得到步进电机执行下一微步的时间间隔,再结合4D马达控制器的方向控制和角位移控制(微步步数),就能实现步进电机的往复运动控制,从而完成超声3D/4D扫描成像过程。
基于上述原理,本申请公开了一种超声探头的步进电机控制方法,参见图3,所述超声探头的步进电机控制方法应用于步进电机的马达控制器中,方法包括:
步骤S101:获取可变参数;
在本申请实施例公开的技术方案中,对所述步进电机的运行速度计算公式进行拆分,将其拆分为两部分,其中一部分记为第一子公式,另一部分记为第二子公式,其中,所述第一子公式中包含有步进电机的扫描参数,所述扫描参数包括:所述马达控制器的时钟频率Freq,步进电机加速和减速过程中的加速度aω,步进电机每运行一微步对应的电机传动杆的步距角k等,所述第一子公式中的计算结果作为所述可变参数,所述可变参数跟随所述扫描参数的变化而变化。在本步骤中,所述第一子公式可以在所述超声主机CPU端进行执行,所述超声主机CPU基于所述扫描参数计算得到第一子公式的计算结果,将所述第一子公式的计算结果下发至所述步进电机的马达控制器。
本步骤中,所述超声主机CPU并不对所述步进电机的运行速度计算公式进行全部运算,其只计算步进电机的运行速度计算公式中的第一子公式即可,降低了超声主机CPU的计算量,降低了超声主机CPU与步进电机的马达控制器之间的数据传输量,提高了数据传输速度。
进一步的,该可变参数可以以32bit的无符号整数(u32)的形式下发给马达控制器;
步骤S102:获取固定计算因子;
本步骤中,所述第二子公式的计算结果作为所述固定计算因子。在本申请实施例公开的方法中,执行本方法之前,在所述马达控制器中预先建立预设映射数据,所述预设映射数据包括第二子公式的计算结果,所述计算结果可以量化为16bit的无符号小数(u0.16),在建立所述预设映射数据时,获取所述第二子公式中的变量数据的变量范围,计算得到所述第二子公式中的变量数据为所述变量范围内的任意一个数值时,将第二子公式的计算结果作为固定计算因子导入所述预设映射数据,并在所述预设映射数据中建立这些结果与所述变量数据的取值之间的映射关系。其中,所述预设映射数据可以为数据列表的形式或者是曲线图的形式,在本申请实施例公开的技术方案中,所述第二子公式中的变量数据指的是用于表征所述超声探头运行时刻的数据,所述变量数据和所述超声探头运行时刻之间存在一一对应的映射关系,因此,也就是说所述第二子公式的计算结果与所述超声探头运行时刻之间存在一一对应的映射关系,本步骤中,在获取所述固定计算因子时,马达控制器首先需要调取所述步进电机的当前运行时刻所对应的变量数据,然后再基于所述变量数据由所述预设映射数据中调取与所述变量数据所对应的固定计算因子。
在本步骤中,所述预设映射数据是已经配置好的,无需马达控制器进行计算,所述马达控制器直接依据所述当前步进电机的运行时刻调取固定计算因子即可,因此,其能够快速的得到所述固定计算因子。
步骤S103:基于固定计算因子和可变参数计算得到所述当前步进电机的运行时刻所对应的步进电机的运行速度;
在本步骤中,所述马达控制器在获取到所述可变参数和固定计算因子以后,将所述可变参数和固定计算因子代替所述步进电机的运行速度计算公式中的第一子公式和第二子公式,即可计算得到所述当前步进电机的运行时刻所对应的步进电机的运行速度。
具体的,在本步骤中,所述马达控制器不需要存储完整的步进电机的运行速度计算公式,只需预存一个简单的预设计算公式即可,所述可变参数和固定计算因子作为所述预设计算公式中的变量,将所述可变参数和固定计算因子带入该预设计算公式,即可得到当前步进电机的运行时刻所对应的步进电机的运行速度。
其中,所述预设计算公式满足条件:
将所述固定计算因子和可变参数代入预设计算公式后得到的计算结果,与采用步进电机的运行速度计算公式计算得到的当前步进电机的运行时刻所对应的步进电机的运行速度相同。
参见本申请上述实施例公开的技术方案,当所述超声主机CPU并不对所述步进电机的运行速度计算公式进行全部运算时,其只计算第一子公式即可,降低了超声主机CPU的计算量,降低了超声主机CPU与步进电机的马达控制器之间的数据传输量,提高了数据传输速度。
在本申请上述实施例公开的技术方案中,所述超声探头的步进电机控制方法既可以应用于线性传动结构的超声探头,此时该方法应用于线性传动结构超声探头的马达控制器中,也可以应用于非线性传动结构的超声探头,此时该方法应用于非线性传动结构超声探头的马达控制器中,因此,仅需要向所述马达控制器写入相关的参数,所述马达控制器可以直接控制所述线性传动结构的超声探头和非线性传动结构的超声探头,从而提高了马达控制器的通用性。
当所述超声探头为线性传动结构,本申请可以采用公式(4)作为所述步进电机的运行速度计算公式,此时,所述当前步进电机的运行时刻为电机运行第n个脉冲的时刻;
即,所述步进电机的运行速度计算公式为:
Figure GDA0002076898650000131
其中,所述n表示所述步进电机运行的脉冲个数,所述Freq为所述马达控制器的时钟频率,所述aω为步进电机加速和减速过程中的加速度,所述为步进电机每运行一微步对应的电机传动杆的步距角。
用户可以依据自身需求对
Figure GDA0002076898650000132
进行拆分,得到用户所需的第一子公式和第二子公式,例如,在本申请实施例公开的技术方案中,所述第一子公式可以为
Figure GDA0002076898650000133
所述第二子公式为
Figure GDA0002076898650000134
当然,所述第一子公式也可以为
Figure GDA0002076898650000135
所述第二子公式也可以为
Figure GDA0002076898650000136
当然,所采用的步进电机的运行速度计算公式不同,得到的所述第一子公式和第二子公式也就不同,基于其他的步进电机的运行速度计算公式所得到的上述方法也在本申请的保护范围之内。
在本申请实施例公开的技术方案中,当将
Figure GDA0002076898650000137
作为第一子公式,将所述
Figure GDA0002076898650000138
作为第二子公式时,所述可变参数κa为:
Figure GDA0002076898650000139
所述固定计算因子△τn+1为:
Figure GDA00020768986500001310
所述将所述固定计算因子和可变参数代入预设计算公式中,计算得到所述当前步进电机的运行时刻所对应的步进电机的运行速度,包括:
将所述固定计算因子和可变参数之积作为当前步进电机的运行时刻所对应的步进电机的运行速度(参见图2所示),即,此时所述预设公式为一个简单的求积公式,将所述固定计算因子和可变参数带入所述求积公式后得到的计算结果即为当前步进电机的运行时刻所对应的步进电机的运行速度。
当所述超声探头为非线性传动结构时,本申请可以采用公式(15)作为所述步进电机的运行速度计算公式,即,所述步进电机的运行速度计算公式为:
Figure GDA0002076898650000141
其中,所述k为步进电机每运行一微步对应换能器摆动的角度,所述Ang为探头芯部单向摆动一次的角度,所述Frm为探头芯部的摆动频率,所述α为探头的偏转角,所述d和R为预设数值,所述γ=β-α,所述β=arctan(R*sinα/(R*cosα-d))。
用户可以依据自身需求对
Figure GDA0002076898650000142
进行拆分,得到用户所需的第一子公式和第二子公式,例如,在本申请实施例公开的技术方案中,所述第一子公式可以为
Figure GDA0002076898650000143
所述第二子公式为
Figure GDA0002076898650000144
在本步骤中,所述
Figure GDA0002076898650000145
的结果仅仅与偏转角度α有关,因此所述
Figure GDA0002076898650000146
的计算结果(固定计算因子)与所述偏转角度α之间存在一一对应的映射关系,又由于所述偏转角度跟随超声探头运行时刻变化而变化,因此,使得所述
Figure GDA0002076898650000147
的计算结果(固定计算因子)与所述超声探头运行时刻之间存在一一对应的映射关系,因此,可以通过所述超声探头运行时刻查找所述预设映射数据,得到与所述超声探头运行时刻所对应的固定计算因子。
在本申请实施例公开的技术方案中,当将
Figure GDA0002076898650000151
作为第一子公式,将所述
Figure GDA0002076898650000152
作为第二子公式时,所述可变参数为:
Figure GDA0002076898650000153
所述固定计算因子为:
Figure GDA0002076898650000154
所述将所述固定计算因子和可变参数代入预设计算公式中,计算得到所述当前步进电机的运行时刻所对应的步进电机的运行速度,包括:
将所述固定计算因子和可变参数之积作为当前步进电机的运行时刻所对应的步进电机的运行速度,即,此时所述预设公式为一个简单的求积公式,将所述固定计算因子和可变参数带入所述求积公式后得到的计算结果即为当前步进电机的运行时刻所对应的步进电机的运行速度。
本实施例中,对应于上述方法,本申请还公开了一种存储介质,所述存储介质上存储有计算机程序,所述计算机程序被处理器执行时,用于实现本申请上述任意一项实施例所述的超声探头的步进电机控制方法。
此外,本申请还公开了一种超声探头,所述超声探头可以为4D超声探头,该探头包括步进电机、步进电机控制器、超声换能器和传动装置,所述传动装置连接所述步进电机和所述超声换能器,所述步进电机控制器内存储有计算机程序,所述计算机程序被所述步进电机控制器执行时,实现本申请上述任意一项实施例所述的超声探头的步进电机控制方法。
在本申请实施例公开的超声探头中,超声换能器的超声主机CPU可以通过UART、SPI、I2C或PCIe等物理通讯接口与所述步进电机的马达控制器进行数据通讯,通过这些物理通讯接口下发数据。
在本申请实施例公开的超声探头中,所述预设映射数据可以存储在马达控制器的内部RAM、寄存器、Flash、DDR或其他片内存储器中,当然也可以存储于外部存储器中。
为了描述的方便,描述以上系统时以功能分为各种模块分别描述。当然,在实施本申请时可以把各模块的功能在同一个或多个软件和/或硬件中实现。
本说明书中的各个实施例均采用递进的方式描述,各个实施例之间相同相似的部分互相参见即可,每个实施例重点说明的都是与其他实施例的不同之处。尤其,对于系统或系统实施例而言,由于其基本相似于方法实施例,所以描述得比较简单,相关之处参见方法实施例的部分说明即可。以上所描述的系统及系统实施例仅仅是示意性的,其中所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部模块来实现本实施例方案的目的。本领域普通技术人员在不付出创造性劳动的情况下,即可以理解并实施。
专业人员还可以进一步意识到,结合本文中所公开的实施例描述的各示例的单元及算法步骤,能够以电子硬件、计算机软件或者二者的结合来实现,为了清楚地说明硬件和软件的可互换性,在上述说明中已经按照功能一般性地描述了各示例的组成及步骤。这些功能究竟以硬件还是软件方式来执行,取决于技术方案的特定应用和设计约束条件。专业技术人员可以对每个特定的应用来使用不同方法来实现所描述的功能,但是这种实现不应认为超出本发明的范围。
结合本文中所公开的实施例描述的方法或算法的步骤可以直接用硬件、处理器执行的软件模块,或者二者的结合来实施。软件模块可以置于随机存储器(RAM)、内存、只读存储器(ROM)、电可编程ROM、电可擦除可编程ROM、寄存器、硬盘、可移动磁盘、CD-ROM、或技术领域内所公知的任意其它形式的存储介质中。
还需要说明的是,在本文中,诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。
对所公开的实施例的上述说明,使本领域专业技术人员能够实现或使用本发明。对这些实施例的多种修改对本领域的专业技术人员来说将是显而易见的,本文中所定义的一般原理可以在不脱离本发明的精神或范围的情况下,在其它实施例中实现。因此,本发明将不会被限制于本文所示的这些实施例,而是要符合与本文所公开的原理和新颖特点相一致的最宽的范围。

Claims (9)

1.一种超声探头的步进电机控制方法,其特征在于,应用于步进电机的马达控制器中,方法包括:
获取可变参数,其中,所述步进电机的运行速度计算公式由第一子公式和第二子公式组合得到,其中,所述第一子公式的计算结果随超声探头的扫描参数变化而变化,所述第一子公式的计算结果作为所述可变参数,所述第二子公式的计算结果与所述超声探头的运行时刻之间一一对应;
从马达控制器存储的预设映射数据中调取与当前步进电机的运行时刻相匹配的固定计算因子,所述预设映射数据中存储有与所述当前步进电机的运行时刻相匹配的固定计算因子,所述第二子公式的计算结果作为所述固定计算因子;
将所述固定计算因子和可变参数代入预设计算公式中,计算得到所述当前步进电机的运行时刻所对应的步进电机的运行速度。
2.根据权利要求1所述的超声探头的步进电机控制方法,其特征在于,所述超声探头为线性传动结构。
3.根据权利要求2所述的超声探头的步进电机控制方法,其特征在于,
所述步进电机的运行速度计算公式为:
Figure FDA0002076898640000011
其中,所述△tn+1为步进电机相邻两微步的间隔时间,表示线性传动结构的超声探头的步进电机的运行速度,所述n表示所述步进电机运行的脉冲个数,所述Freq为所述马达控制器的时钟频率,所述aω为步进电机加速和减速过程中的加速度,所述k为步进电机每运行一微步对应的电机传动杆的步距角。
4.根据权利要求3所述的超声探头的步进电机控制方法,其特征在于,
所述可变参数为:
Figure FDA0002076898640000021
所述固定计算因子为:
Figure FDA0002076898640000022
所述将所述固定计算因子和可变参数代入预设计算公式中,计算得到所述当前步进电机的运行时刻所对应的步进电机的运行速度,包括:
将所述固定计算因子和可变参数之积作为当前步进电机的运行时刻所对应的步进电机的运行速度。
5.根据权利要求1所述的超声探头的步进电机控制方法,其特征在于,所述超声探头为非线性传动结构。
6.根据权利要求5所述的超声探头的步进电机控制方法,其特征在于,
所述步进电机的运行速度计算公式为:
Figure FDA0002076898640000023
其中,△t为步进电机相邻两微步的间隔时间,表示非线性传动结构的超声探头的步进电机的运行速度,所述k为步进电机每运行一微步对应的电机传动杆的步距角,所述Ang为探头芯部单向摆动一次的角度,所述Frm为探头芯部的摆动频率,所述α为探头的偏转角,所述d和R为预设数值,所述γ=β-α,所述β=arctan(R*sinα/(R*cosα-d))。
7.根据权利要求6所述的超声探头的步进电机控制方法,其特征在于,
所述可变参数为:
Figure FDA0002076898640000024
所述固定计算因子为:
Figure FDA0002076898640000025
所述将所述固定计算因子和可变参数代入预设计算公式中,计算得到所述当前步进电机的运行时刻所对应的步进电机的运行速度,包括:
将所述固定计算因子和可变参数之积作为当前步进电机的运行时刻所对应的步进电机的运行速度。
8.一种存储介质,其特征在于,所述存储介质上存储有计算机程序,所述计算机程序被处理器执行时,实现如权利要求1至7中任一权利要求所述的超声探头的步进电机控制方法。
9.一种超声探头,其特征在于,包括步进电机、步进电机控制器、超声换能器和传动装置,所述传动装置连接所述步进电机和所述超声换能器,所述步进电机控制器内存储有计算机程序,所述计算机程序被所述步进电机控制器执行时,实现权利要求1至7任意一项权利要求所述的超声探头的步进电机控制方法。
CN201910217671.6A 2019-03-21 2019-03-21 超声探头的步进电机控制方法、存储介质以及超声探头 Active CN110051382B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910217671.6A CN110051382B (zh) 2019-03-21 2019-03-21 超声探头的步进电机控制方法、存储介质以及超声探头

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910217671.6A CN110051382B (zh) 2019-03-21 2019-03-21 超声探头的步进电机控制方法、存储介质以及超声探头

Publications (2)

Publication Number Publication Date
CN110051382A CN110051382A (zh) 2019-07-26
CN110051382B true CN110051382B (zh) 2021-07-23

Family

ID=67316256

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910217671.6A Active CN110051382B (zh) 2019-03-21 2019-03-21 超声探头的步进电机控制方法、存储介质以及超声探头

Country Status (1)

Country Link
CN (1) CN110051382B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7559569B2 (ja) 2021-01-22 2024-10-02 コニカミノルタ株式会社 超音波探触子、超音波診断装置及びプログラム

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103371854A (zh) * 2012-04-13 2013-10-30 深圳市蓝韵实业有限公司 四维超声探头驱动方法和装置
CN103860204A (zh) * 2014-03-31 2014-06-18 深圳市开立科技有限公司 一种应用于四维超声探头的步进电机控制系统
WO2014105526A1 (en) * 2012-12-27 2014-07-03 Volcano Corporation Fire control system for rotational ivus
CN106725601A (zh) * 2017-01-04 2017-05-31 沈阳东软医疗系统有限公司 一种步进电机的自动校准方法、装置和成像系统

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103371854A (zh) * 2012-04-13 2013-10-30 深圳市蓝韵实业有限公司 四维超声探头驱动方法和装置
WO2014105526A1 (en) * 2012-12-27 2014-07-03 Volcano Corporation Fire control system for rotational ivus
CN103860204A (zh) * 2014-03-31 2014-06-18 深圳市开立科技有限公司 一种应用于四维超声探头的步进电机控制系统
CN106725601A (zh) * 2017-01-04 2017-05-31 沈阳东软医疗系统有限公司 一种步进电机的自动校准方法、装置和成像系统

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
超声电机驱动的大行程、高精度二维运动平台关键技术的研究;王金鹏;《中国博士学位论文全文数据库 工程科技Ⅱ辑》;20141215(第12期);第1-117页 *

Also Published As

Publication number Publication date
CN110051382A (zh) 2019-07-26

Similar Documents

Publication Publication Date Title
CN106725601B (zh) 一种步进电机的自动校准方法、装置和成像系统
CN103860204B (zh) 一种应用于四维超声探头的步进电机控制系统
JP3234177B2 (ja) 位置制御装置
CN110051382B (zh) 超声探头的步进电机控制方法、存储介质以及超声探头
US4398422A (en) Ultrasonic-image device
JP2009028366A (ja) 超音波診断装置
JPH09318733A (ja) ビーム形成器及び超音波イメージング・システム
CN101930351B (zh) 基于cordic的信号处理方法和装置
US7457654B2 (en) Artifact reduction for volume acquisition
CN111800040B (zh) 步进电机及其复位方法、装置及计算机可读存储介质
JP2017200274A (ja) 超音波モータの制御方法及びそのための測量機
US6834241B2 (en) Programmable coriolis flow meter electronics for outputting information over a single output port
JPH11507799A (ja) ステップモータの制御方法及び制御装置
JPH06276773A (ja) 駆動制御方法及び駆動制御装置
US6677723B2 (en) Circuit for driving stepping motor
CN208942194U (zh) 一种超声成像探头及弹性成像设备
EP3711676B1 (en) Ultrasound imaging apparatus and method of controlling the same
JPH03182237A (ja) 超音波結像方法及び装置
JP4692705B2 (ja) 粘弾性材料の試験方法
JP4041392B2 (ja) 機械走査型超音波診断装置
JPH11258076A (ja) モータトルクリップル測定装置
CN116058870B (zh) 超声数据的处理方法、装置、成像系统及可读存储介质
CN109974574A (zh) 一种炒菜机中搅拌臂的摆动角度检测方法和炒菜机
JP3616746B2 (ja) 超音波診断装置
JP3346733B2 (ja) 超音波診断装置

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
GR01 Patent grant
GR01 Patent grant