CN114748101B - 超声扫查控制方法、***及计算机可读存储介质 - Google Patents

超声扫查控制方法、***及计算机可读存储介质 Download PDF

Info

Publication number
CN114748101B
CN114748101B CN202210671513.XA CN202210671513A CN114748101B CN 114748101 B CN114748101 B CN 114748101B CN 202210671513 A CN202210671513 A CN 202210671513A CN 114748101 B CN114748101 B CN 114748101B
Authority
CN
China
Prior art keywords
scanning
end point
pressure
ultrasonic
angle
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
CN202210671513.XA
Other languages
English (en)
Other versions
CN114748101A (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.)
Shenzhen Hanwei Intelligent Medical Technology Co ltd
Original Assignee
Shenzhen Hanwei Intelligent Medical Technology Co ltd
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 Shenzhen Hanwei Intelligent Medical Technology Co ltd filed Critical Shenzhen Hanwei Intelligent Medical Technology Co ltd
Priority to CN202210671513.XA priority Critical patent/CN114748101B/zh
Publication of CN114748101A publication Critical patent/CN114748101A/zh
Application granted granted Critical
Publication of CN114748101B publication Critical patent/CN114748101B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B8/00—Diagnosis using ultrasonic, sonic or infrasonic waves
    • A61B8/08—Detecting organic movements or changes, e.g. tumours, cysts, swellings
    • A61B8/0825—Detecting organic movements or changes, e.g. tumours, cysts, swellings for diagnosis of the breast, e.g. mammography
    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B8/00—Diagnosis using ultrasonic, sonic or infrasonic waves
    • A61B8/44—Constructional features of the ultrasonic, sonic or infrasonic diagnostic device
    • A61B8/4444—Constructional features of the ultrasonic, sonic or infrasonic diagnostic device related to the probe
    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B8/00—Diagnosis using ultrasonic, sonic or infrasonic waves
    • A61B8/54—Control of the diagnostic device

Landscapes

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

Abstract

本发明公开了一种超声扫查控制方法、***及计算机可读存储介质，方法包括：获取超声探头的实际扫查压力和期望扫查压力；在期望扫查压力不等于实际扫查压力时，根据期望扫查压力和实际扫查压力的差值，确定分量坐标以及分量角度；获取历史终点坐标以及历史终点角度；根据分量坐标与历史终点坐标确定目标终点坐标，以及根据分量角度与历史终点角度确定目标终点角度；根据目标终点坐标和目标终点角度控制超声扫查控制***。本发明提高了超声扫查的安全性和超声图像质量的稳定性。

Description

超声扫查控制方法、***及计算机可读存储介质
技术领域
本发明涉及超声扫查技术领域，尤其涉及一种超声扫查控制方法、***及计算机可读存储介质。
背景技术
机器人辅助超声扫查中，以乳腺扫查为例，同一个人胸部不同部位、不同的人的胸部，其柔软程度都是不一样的，甚至差别很大，而现存技术手段往往是基于预设控制参数进行扫查，针对不同的胸部柔软程度，扫查压力的适应性弱，压力大容易对受检者身体造成身体损害，导致超声扫查的安全性降低，扫查压力的不稳定也会导致超声图像质量不稳定。
发明内容
本发明实施例通过提供一种超声扫查控制方法、***及计算机可读存储介质，旨在解决如何提高超声扫查的安全性以及超声图像质量不稳定的技术问题。
本发明实施例提供一种超声扫查控制方法，应用于超声扫查控制***，所述方法包括：
获取超声探头的实际扫查压力和期望扫查压力；
在所述期望扫查压力不等于所述实际扫查压力时，根据所述期望扫查压力和所述实际扫查压力的差值，确定分量坐标以及分量角度；
获取历史终点坐标以及历史终点角度；
根据所述分量坐标与所述历史终点坐标确定目标终点坐标，以及根据所述分量角度与所述历史终点角度确定目标终点角度；
根据所述目标终点坐标和所述目标终点角度控制超声扫查控制***。
在一实施例中，所述在所述期望扫查压力不等于所述实际扫查压力时，根据所述期望扫查压力和所述实际扫查压力的差值，确定分量坐标以及分量角度的步骤包括：
在所述期望扫查压力不等于所述实际扫查压力时，获取所述期望扫查压力和所述实际扫查压力的差值；
对所述差值进行误差限幅，得到限幅差值；
根据所述限幅差值确定PID输出值；
对所述PID输出值进行输出限幅，得到PID限幅输出值；
根据所述PID限幅输出值进行位移分量计算，得到所述分量坐标以及所述分量角度。
在一实施例中，所述根据所述PID限幅输出值进行位移分量计算，得到所述分量坐标以及所述分量角度的步骤包括：
获取所述超声探头的当前角度；
获取所述当前角度对应的法向量；
根据所述法向量将所述PID限幅输出值分解到笛卡尔坐标系的x、y、z轴，得到所述分量坐标，并将分量角度设置为（0,0,0）。
在一实施例中，所述根据所述限幅差值确定PID输出值的步骤包括：
根据预设的PID参数以及所述限幅差值确定所述PID输出值。
在一实施例中，所述获取超声探头的实际扫查压力和期望扫查压力的步骤包括：
检测所述超声探头的接触力，并获取重力补偿值；
将所述接触力与所述重力之和作为所述实际扫查压力，并获取预设的所述期望扫查压力。
在一实施例中，所述检测所述超声探头的接触力，并获取重力补偿值的步骤包括：
检测所述超声探头的接触力，并获取所述超声探头的方向矢量；
根据所述超声探头的方向矢量和预设的重力加速度确定所述重力补偿值。
在一实施例中，所述根据所述目标终点坐标和所述目标终点角度控制超声扫查控制***的步骤包括：
根据所述目标终点坐标和所述目标终点角度确定机械臂关节值，并通过所述机械臂关节值控制所述超声扫查控制***，以调整所述超声扫查控制***的超声探头的压力。
在一实施例中，所述根据所述目标终点坐标和所述目标终点角度确定机械臂关节值，并通过所述机械臂关节值控制所述超声扫查控制***的步骤包括：
获取所述超声扫查控制***的超声探头的当前坐标以及当前角度；
根据所述当前坐标、所述当前角度、所述目标终点坐标以及所述目标终点角度确定扫查轨迹；
根据所述扫查轨迹上的扫查坐标以及扫查角度进行逆运动学计算，得到所述扫查轨迹对应的所述机械臂关节值；
根据所述机械臂关节值控制所述超声扫查控制***，以调整所述超声扫查控制***的超声探头的压力。
本发明实施例还提供一种超声扫查控制***，所述超声扫查控制***包括：存储器、处理器及存储在所述存储器上并可在处理器上运行的计算机程序，所述处理器执行所述计算机程序时实现如上所述的超声扫查控制方法的各个步骤。
本发明实施例还提供一种计算机可读存储介质，所述计算机可读存储介质上存储有计算机程序，所述计算机程序被处理器执行时实现如上所述的超声扫查控制方法的各个步骤。
在本实施例的技术方案中，获取超声探头的实际扫查压力和期望扫查压力；在所述期望扫查压力不等于所述实际扫查压力时，根据所述期望扫查压力和所述实际扫查压力的差值，确定分量坐标以及分量角度；获取历史终点坐标以及历史终点角度；根据所述分量坐标与所述历史终点坐标确定目标终点坐标，以及根据所述分量角度与所述历史终点角度确定目标终点角度；根据所述目标终点坐标和所述目标终点角度控制超声扫查控制***。由于超声扫查控制***可获取超声探头的实际扫查压力和期望扫查压力并进行判定，在判断结果为期望扫查压力不等于实际扫查压力时，可根据期望扫查压力和实际扫查压力的差值确定分量坐标以及分量角度。最后根据分量坐标和角度改变机械臂的终点坐标和终点角度。基于改变后的坐标和角度控制超声扫查控制***的机械臂，可使得超声探头的实际扫查压力与期望扫查压力对应，从而提高超声扫查的安全性和超声图像质量的稳定性。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
图1为本发明实施例涉及的超声扫查控制***的硬件构架示意图；
图2为本发明超声扫查控制方法第一实施例的流程示意图；
图3为本发明超声扫查控制方法第一实施例的参考图；
图4为本发明超声扫查控制方法第二实施例的流程示意图；
图5为本发明超声扫查控制方法第二实施例的参考图；
图6为本发明超声扫查控制方法第二实施例的参考图。
具体实施方式
为了更好的理解上述技术方案，下面将参照附图更详细地描述本公开的示例性实施例。虽然附图中显示了本公开的示例性实施例，然而应当理解，可以以各种形式实现本公开而不应被这里阐述的实施例所限制。相反，提供这些实施例是为了能够更透彻地理解本公开，并且能够将本公开的范围完整的传达给本领域的技术人员。
本发明的主要解决方案是：获取超声探头的实际扫查压力和期望扫查压力；在所述期望扫查压力不等于所述实际扫查压力时，根据所述期望扫查压力和所述实际扫查压力的差值，确定分量坐标以及分量角度；获取历史终点坐标以及历史终点角度；根据所述分量坐标与所述历史终点坐标确定目标终点坐标，以及根据所述分量角度与所述历史终点角度确定目标终点角度；根据所述目标终点坐标和所述目标终点角度控制超声扫查控制***。
由于超声扫查控制***可获取超声探头的实际扫查压力和期望扫查压力并进行判定，在判断结果为期望扫查压力不等于实际扫查压力时，可根据期望扫查压力和实际扫查压力的差值确定分量坐标以及分量角度。最后根据分量坐标和角度改变机械臂的终点坐标和终点角度。基于改变后的坐标和角度控制超声扫查控制***的机械臂，可使得超声探头的实际扫查压力与期望扫查压力对应，从而提高超声扫查的安全性和超声图像质量的稳定性。
作为一种实现方式，超声扫查控制***可以如图1。
本发明实施例方案涉及的是超声扫查控制***，超声扫查控制***包括：处理器101，例如CPU，存储器102，通信总线103。其中，通信总线103用于实现这些组件之间的连接通信。
存储器102可以是高速RAM存储器，也可以是稳定的存储器（non-volatilememory），例如磁盘存储器。如图1，作为一种计算机可读存储介质的存储器103中可以包括检测程序；而处理器101可以用于调用存储器102中存储的检测程序，并执行以下操作：
获取超声探头的实际扫查压力和期望扫查压力；
在所述期望扫查压力不等于所述实际扫查压力时，根据所述期望扫查压力和所述实际扫查压力的差值，确定分量坐标以及分量角度；
获取历史终点坐标以及历史终点角度；
根据所述分量坐标与所述历史终点坐标确定目标终点坐标，以及根据所述分量角度与所述历史终点角度确定目标终点角度；
根据所述目标终点坐标和所述目标终点角度控制超声扫查控制***。
在一实施例中，处理器101可以用于调用存储器102中存储的检测程序，并执行以下操作：
在所述期望扫查压力不等于所述实际扫查压力时，获取所述期望扫查压力和所述实际扫查压力的差值；
对所述差值进行误差限幅，得到限幅差值；
根据所述限幅差值确定PID输出值；
对所述PID输出值进行输出限幅，得到PID限幅输出值；
根据所述PID限幅输出值进行位移分量计算，得到所述分量坐标以及所述分量角度。
在一实施例中，处理器101可以用于调用存储器102中存储的检测程序，并执行以下操作：
获取所述超声探头的当前角度；
获取所述当前角度对应的法向量；
根据所述法向量将所述PID限幅输出值分解到笛卡尔坐标系的x、y、z轴，得到所述分量坐标，并将分量角度设置为（0,0,0）。
在一实施例中，处理器101可以用于调用存储器102中存储的检测程序，并执行以下操作：
根据预设的PID参数以及所述限幅差值确定所述PID输出值。
在一实施例中，处理器101可以用于调用存储器102中存储的检测程序，并执行以下操作：
检测所述超声探头的接触力，并获取重力补偿值；
将所述接触力与所述重力之和作为所述实际扫查压力，并获取预设的所述期望扫查压力。
在一实施例中，处理器101可以用于调用存储器102中存储的检测程序，并执行以下操作：
检测所述超声探头的接触力，并获取所述超声探头的方向矢量；
根据所述超声探头的方向矢量和预设的重力加速度确定所述重力补偿值。
在一实施例中，处理器101可以用于调用存储器102中存储的检测程序，并执行以下操作：
根据所述目标终点坐标和所述目标终点角度确定机械臂关节值，并通过所述机械臂关节值控制所述超声扫查控制***，以调整所述超声扫查控制***的超声探头的压力。
在一实施例中，处理器101可以用于调用存储器102中存储的检测程序，并执行以下操作：
获取所述超声扫查控制***的超声探头的当前坐标以及当前角度；
根据所述当前坐标、所述当前角度、所述目标终点坐标以及所述目标终点角度确定扫查轨迹；
根据所述扫查轨迹上的扫查坐标以及扫查角度进行逆运动学计算，得到所述扫查轨迹对应的所述机械臂关节值；
根据所述机械臂关节值控制所述超声扫查控制***，以调整所述超声扫查控制***的超声探头的压力。
在本实施例的技术方案中，获取超声探头的实际扫查压力和期望扫查压力；在所述期望扫查压力不等于所述实际扫查压力时，根据所述期望扫查压力和所述实际扫查压力的差值，确定分量坐标以及分量角度；获取历史终点坐标以及历史终点角度；根据所述分量坐标与所述历史终点坐标确定目标终点坐标，以及根据所述分量角度与所述历史终点角度确定目标终点角度；根据所述目标终点坐标和所述目标终点角度控制超声扫查控制***。由于超声扫查控制***可获取超声探头的实际扫查压力和期望扫查压力并进行判定，在判断结果为期望扫查压力不等于实际扫查压力时，可根据期望扫查压力和实际扫查压力的差值确定分量坐标以及分量角度。最后根据分量坐标和角度改变机械臂的终点坐标和终点角度。基于改变后的坐标和角度控制超声扫查控制***的机械臂，可使得超声探头的实际扫查压力与期望扫查压力对应，从而提高超声扫查的安全性和超声图像质量的稳定性。
为了更好的理解上述技术方案，下面将结合说明书附图以及具体的实施方式对上述技术方案进行详细的说明。
参照图2，图2为本发明超声扫查控制方法的第一实施例，方法包括以下步骤：
步骤S10，获取超声探头的实际扫查压力和期望扫查压力。
机器人辅助乳腺扫查已经成为一个研究热点，机器人辅助乳腺扫查中两个重要目标是获取高质量的超声图像和保证扫描安全性。要获取高质量的超声图像和保证安全性关键是要实现超声探头与皮肤贴合，并保持稳定的接触压力（恒压）。同一个人胸部不同部位，不同的人的胸部其柔软程度都是不一样的，甚至差别很大。
路径数学形式为：每条扫查轨路径{Pi, 0<=i<N}是由N个间隔很密5mm的点Pi组成的，其中，
Figure 585365DEST_PATH_IMAGE001
这6个量分别表示探头在Pi位置的坐标和角度。
路径来源：通过结构光传感器采集得到人体表面的点云，点云通过自动分割及路径规划算法生成扫查路径。
如图3所示，图3为右胸超声扫查的路径，超声扫查的路径可以分为四个阶段，AB段是探头下探阶段，在B点开始接触人体皮肤；BC段是超声扫查阶段，这个阶段进行超声图像采集；CD段是探头上抬阶段，此时探头抬起一定高度，离开人体皮肤；DE段是过渡段，探头移动到待扫查段FG上方，进行新一段扫查。需要进行恒压控制的是超声录制段BC、FG……。
在本实施例中，实际扫查压力根据超声扫查控制***中的预设装置获取。期望扫查压力可为预设的数值，在采集搭配实际扫查压力时用于进行比对。
可选的，检测所述超声探头的接触力，并获取重力补偿值；
将所述接触力与所述重力之和作为所述实际扫查压力，并获取预设的所述期望扫查压力。具体的，检测所述超声探头的接触力，并获取所述超声探头的方向矢量；根据所述超声探头的方向矢量和预设的重力加速度确定所述重力补偿值。
步骤S20，在所述期望扫查压力不等于所述实际扫查压力时，根据所述期望扫查压力和所述实际扫查压力的差值，确定分量坐标以及分量角度。
在本实施例中，当超声扫查控制***判定期望扫查压力不等于实际扫查压力时，计算期望扫查压力和所述实际扫查压力的差值，并基于上述差值计算一个
Figure 999029DEST_PATH_IMAGE002
，即上述分量坐标以及分量角度。
可选的，获取所述超声探头的当前角度；获取所述当前角度对应的法向量；根据所述法向量将所述PID限幅输出值分解到笛卡尔坐标系的x、y、z轴，得到所述分量坐标，并将分量角度设置为（0,0,0）。其中，通过本实施例，可通过调整机械臂的坐标改变探头压力。
可选的，在所述期望扫查压力不等于所述实际扫查压力时，获取所述期望扫查压力和所述实际扫查压力的差值；对所述差值进行误差限幅，得到限幅差值；根据所述限幅差值确定PID输出值；对所述PID输出值进行输出限幅，得到PID限幅输出值；根据所述PID限幅输出值进行位移分量计算，得到所述分量坐标以及所述分量角度。进一步的，根据预设的PID参数以及所述限幅差值确定所述PID输出值。
步骤S30，获取历史终点坐标以及历史终点角度。
在本实施例中，当确定了分量坐标和分量角度，会获取一个
Figure 476146DEST_PATH_IMAGE003
，作为上述历史终坐标以及历史终点角度。其中，历史终点坐标以及历史终点角度为探头未进行压力调整前的历史终点位姿。
步骤S40，根据所述分量坐标与所述历史终点坐标确定目标终点坐标，以及根据所述分量角度与所述历史终点角度确定目标终点角度。
在本实施例中，当获取到分量坐标、分量角度以及历史终点坐标以及历史终点角度时，将上述数据对于相加，得到目标终点坐标以及目标终点角度
Figure 12170DEST_PATH_IMAGE004
。
步骤S50，根据所述目标终点坐标和所述目标终点角度控制超声扫查控制***。
在本实施例中，根据得到的目标终点坐标以及目标终点角度调整超声扫查控制***的控制参数，以进行控制。
在本实施例的技术方案中，由于超声扫查控制***可获取超声探头的实际扫查压力和期望扫查压力并进行判定，在判断结果为期望扫查压力不等于实际扫查压力时，可根据期望扫查压力和实际扫查压力的差值确定分量坐标以及分量角度。最后根据分量坐标和角度改变机械臂的终点坐标和终点角度。基于改变后的坐标和角度控制超声扫查控制***的机械臂，可使得超声探头的实际扫查压力与期望扫查压力对应，从而提高超声扫查的安全性和超声图像质量的稳定性。
参照图4，图4为本发明超声扫查控制方法的第二实施例，基于第一实施例，步骤S50包括：
步骤S51，根据所述目标终点坐标和所述目标终点角度确定机械臂关节值，并通过所述机械臂关节值控制所述超声扫查控制***，以调整所述超声扫查控制***的超声探头的压力。
在本实施例中，机械臂关节值用于控制机械臂，其中，机械臂可改变探头的位置个角度，当确定目标终点坐标和目标终点角度，可通过逆运动学算法计算机械臂在剩余扫查轨迹中各个点位的控制参数。
可选的，获取所述超声扫查控制***的超声探头的当前坐标以及当前角度；根据所述当前坐标、所述当前角度、所述目标终点坐标以及所述目标终点角度确定扫查轨迹；根据所述扫查轨迹上的扫查坐标以及扫查角度进行逆运动学计算，得到所述扫查轨迹对应的所述机械臂关节值；根据所述机械臂关节值控制所述超声扫查控制***，以调整所述超声扫查控制***的超声探头的压力。
可选的，本实施例实现框图参考图5，
Figure 981263DEST_PATH_IMAGE005
为期望扫查压力；为
Figure 732706DEST_PATH_IMAGE006
探头对皮肤造成的实际扫查压力；
Figure 329909DEST_PATH_IMAGE007
为压力传感器的测量值；
Figure 771255DEST_PATH_IMAGE008
为期望的扫查压力和探头与皮肤的实际压力之差；
Figure 493223DEST_PATH_IMAGE009
误差限幅函数后的输出；
Figure 842165DEST_PATH_IMAGE010
为PID控制器的输出；
Figure 231558DEST_PATH_IMAGE011
为输出限幅后的输出；
Figure 47067DEST_PATH_IMAGE012
为
Figure 598876DEST_PATH_IMAGE011
在笛卡尔坐标空间在x,y,z三个方向的分量（分量坐标以及分量角度）；
Figure 220351DEST_PATH_IMAGE013
为扫查路径在该周期的插补点（历史终点坐标和历史终点角度）。
误差限幅：误差限幅是为了提高控制器的适应性，避免输入误差过大导致输出的冲击，按下式计算：
Figure 933092DEST_PATH_IMAGE014
其中
Figure 247398DEST_PATH_IMAGE015
为设定的限制值。
PID控制器：PID控制器是恒压控制的核心环节，控制律如下：
Figure 271855DEST_PATH_IMAGE016
其中为
Figure 837965DEST_PATH_IMAGE017
比例环节、积分环节和微分环节的常数，根据实际机器人调试结果进行PID参数整定。
输出限幅：输出限幅是提高恒压控制的适应性和安全性，避免过大的控制量输出，引起机器人振动。
位移分量计算：根据当前探头的姿态角，计算出探头轴向的法向量，把PID恒压控制器的输出位移分解到笛卡尔坐标系的x,y,z轴。
机器人的姿态矩阵为：
Figure 470460DEST_PATH_IMAGE018
其中，S和C为预设的数值。
第三列为探头的法向量，位移分量的计算按下式进行：
Figure 955668DEST_PATH_IMAGE019
位置调整：把恒压控制器的输出
Figure 467420DEST_PATH_IMAGE020
与参考路径的插补输出
Figure 165118DEST_PATH_IMAGE021
进行叠加，得到末端探头的实际位置输出
Figure 852451DEST_PATH_IMAGE022
（目标终点坐标以及目标终点角度），即
Figure 777069DEST_PATH_IMAGE023
。
逆运动学计算：逆运动学计算根据超声探头的位姿计算出机器人各个关节量。值得注意的是，恒压控制方法适用于不同的机器人，对于不同的机器人只是逆运动学计算有所不同，在此不做限定。
重力补偿：本实施例的超声探头夹持一个实现方式如图6所示的预设装置，所有物理量都在机器人基坐标系下描述，基坐标系Z轴与重力方向是共线反向的，
Figure 713801DEST_PATH_IMAGE024
为接触力，G为重力，
Figure 418452DEST_PATH_IMAGE025
为传感器测量的力，
Figure 553767DEST_PATH_IMAGE026
为探头的方向矢量
Figure 849620DEST_PATH_IMAGE027
，设Z轴方向矢量为
Figure 742489DEST_PATH_IMAGE027
，
Figure 784919DEST_PATH_IMAGE028
为
Figure 774741DEST_PATH_IMAGE026
与
Figure 241494DEST_PATH_IMAGE027
的夹角。控制目标是保持接触力与期望力一致，重力补偿是考虑重力对接触力的影响，具体关系如下：
Figure 621660DEST_PATH_IMAGE029
所以对反馈力的输入要叠加上重力的分量，作为力控制器的反馈输入。设力控制器的反馈输入为
Figure 996009DEST_PATH_IMAGE030
。
Figure 309179DEST_PATH_IMAGE031
定时器中断处理：上述计算和控制过程需要具有定时器中断功能的MCU，上述控制过程都在中断服务函数中完成，为了控制的稳定性和精度，中断周期要小于5ms。
在本实施例的技术方案中，通过逆运动学计算，只要确定机械臂的目标终点坐标和目标终点角度即可确定机械臂在剩余扫查流程中各个时刻的控制参数，因此，当基于实际扫查压力和期望扫查压力确定出分量坐标以及分量角度时，可基于历史终点坐标和历史终点角度进行探头压力的控制。
为实现上述目的，本发明实施例还提供一种超声扫查控制***，所述超声扫查控制***包括：存储器、处理器及存储在所述存储器上并可在处理器上运行的计算机程序，所述处理器执行所述计算机程序时实现如上所述的超声扫查控制方法的各个步骤。
为实现上述目的，本发明实施例还提供一种计算机可读存储介质，所述计算机可读存储介质上存储有计算机程序，所述计算机程序被处理器执行时实现如上所述的超声扫查控制方法的各个步骤。
本领域内的技术人员应明白，本发明的实施例可提供为方法、***、或计算机程序产品。因此，本发明可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且，本发明可采用在一个或多个其中包含有计算机可用程序代码的计算机可用计算机可读存储介质（包括但不限于磁盘存储器、CD-ROM、光学存储器等）上实施的计算机程序的形式。
本发明是参照根据本发明实施例的方法、设备（***）、和计算机程序产品的流程图和／或方框图来描述的。应理解可由计算机程序指令实现流程图和／或方框图中的每一流程和／或方框、以及流程图和／或方框图中的流程和／或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产生一个机器，使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和／或方框图一个方框或多个方框中指定的功能的装置。
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理设备以特定方式工作的计算机可读存储器中，使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品，该指令装置实现在流程图一个流程或多个流程和／或方框图一个方框或多个方框中指定的功能。
这些计算机程序指令也可装载到计算机或其他可编程数据处理设备上，使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理，从而在计算机或其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和／或方框图一个方框或多个方框中指定的功能的步骤。
应当注意的是，在权利要求中，不应将位于括号之间的任何参考符号构造成对权利要求的限制。单词“包含”不排除存在未列在权利要求中的部件或步骤。位于部件之前的单词“一”或“一个”不排除存在多个这样的部件。本发明可以借助于包括有若干不同部件的硬件以及借助于适当编程的计算机来实现。在列举了若干装置的单元权利要求中，这些装置中的若干个可以是通过同一个硬件项来具体体现。单词第一、第二、以及第三等的使用不表示任何顺序。可将这些单词解释为名称。
尽管已描述了本发明的优选实施例，但本领域内的技术人员一旦得知了基本创造性概念，则可对这些实施例作出另外的变更和修改。所以，所附权利要求意欲解释为包括优选实施例以及落入本发明范围的所有变更和修改。
显然，本领域的技术人员可以对本发明进行各种改动和变型而不脱离本发明的精神和范围。这样，倘若本发明的这些修改和变型属于本发明权利要求及其等同技术的范围之内，则本发明也意图包含这些改动和变型在内。

Claims (6)

1.一种超声扫查控制方法，其特征在于，应用于超声扫查控制***，所述方法包括：
获取超声探头的实际扫查压力和期望扫查压力；
在所述期望扫查压力不等于所述实际扫查压力时，根据所述期望扫查压力和所述实际扫查压力的差值；
对所述差值进行误差限幅，得到限幅差值，所述限幅差值根据所述差值以及设定的限定值确定，在所述差值的绝对值超出所述设定的限定值时，根据设定的限定值确定所述限幅差值，在所述差值的绝对值小于所述设定的限定值时，将所述差值确定为所述限幅差值；
根据所述限幅差值确定PID输出值；
对所述PID输出值进行输出限幅，得到PID限幅输出值；
获取所述超声探头的当前角度；
获取所述当前角度对应的法向量；
根据所述法向量将所述PID限幅输出值分解到笛卡尔坐标系的x、y、z轴，得到分量坐标，并将分量角度设置为（0,0,0）；
获取历史终点坐标以及历史终点角度，所述历史终点坐标以及历史终点角度为所述超声探头未进行压力调整前的历史终点位姿；
根据所述分量坐标与所述历史终点坐标确定目标终点坐标，以及根据所述分量角度与所述历史终点角度确定目标终点角度，根据所述分量坐标与所述历史终点坐标确定目标终点坐标的方式为将所述分量坐标以及所述历史终点坐标进行相加，根据所述分量角度与所述历史终点角度确定目标终点角度的方式为将所述分量角度与所述历史终点角度进行相加；
根据所述目标终点坐标和所述目标终点角度调整超声扫查控制***的控制参数，以控制超声扫查控制***，所述控制参数包括机械臂关节值，以使超声探头的实际扫查压力与期望扫查压力对应；
其中，根据所述目标终点坐标和所述目标终点角度调整超声扫查控制***的控制参数，以控制超声扫查控制***的步骤包括：
根据所述目标终点坐标和所述目标终点角度确定机械臂关节值，并通过所述机械臂关节值控制所述超声扫查控制***，以调整所述超声扫查控制***的超声探头的压力；
根据所述目标终点坐标和所述目标终点角度确定机械臂关节值，并通过所述机械臂关节值控制所述超声扫查控制***的步骤包括：
获取所述超声扫查控制***的超声探头的当前坐标以及当前角度；
根据所述当前坐标、所述当前角度、所述目标终点坐标以及所述目标终点角度确定扫查轨迹；
根据所述扫查轨迹上的扫查坐标以及扫查角度进行逆运动学计算，得到所述扫查轨迹对应的所述机械臂关节值；
根据所述机械臂关节值控制所述超声扫查控制***，以调整所述超声扫查控制***的超声探头的压力。
2.如权利要求1所述的超声扫查控制方法，其特征在于，所述根据所述限幅差值确定PID输出值的步骤包括：
根据预设的PID参数以及所述限幅差值确定所述PID输出值。
3.如权利要求1所述的超声扫查控制方法，其特征在于，所述获取超声探头的实际扫查压力和期望扫查压力的步骤包括：
检测所述超声探头的接触力，并获取重力补偿值；
将所述接触力与所述重力之和作为所述实际扫查压力，并获取预设的所述期望扫查压力。
4.如权利要求3所述的超声扫查控制方法，其特征在于，所述检测所述超声探头的接触力，并获取重力补偿值的步骤包括：
检测所述超声探头的接触力，并获取所述超声探头的方向矢量；
根据所述超声探头的方向矢量和预设的重力加速度确定所述重力补偿值。
5.一种超声扫查控制***，其特征在于，所述超声扫查控制***包括：存储器、处理器及存储在所述存储器上并可在处理器上运行的计算机程序，所述处理器执行所述计算机程序时实现如权利要求1至4中任一项所述的超声扫查控制方法的步骤。
6.一种计算机可读存储介质，其特征在于，所述计算机可读存储介质上存储有计算机程序，所述计算机程序被处理器执行时实现如权利要求1至4中任一项所述的超声扫查控制方法的步骤。
CN202210671513.XA 2022-06-15 2022-06-15 超声扫查控制方法、***及计算机可读存储介质 Active CN114748101B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210671513.XA CN114748101B (zh) 2022-06-15 2022-06-15 超声扫查控制方法、***及计算机可读存储介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210671513.XA CN114748101B (zh) 2022-06-15 2022-06-15 超声扫查控制方法、***及计算机可读存储介质

Publications (2)

Publication Number Publication Date
CN114748101A CN114748101A (zh) 2022-07-15
CN114748101B true CN114748101B (zh) 2022-11-01

Family

ID=82336667

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210671513.XA Active CN114748101B (zh) 2022-06-15 2022-06-15 超声扫查控制方法、***及计算机可读存储介质

Country Status (1)

Country Link
CN (1) CN114748101B (zh)

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4808063A (en) * 1987-11-03 1989-02-28 Westinghouse Electric Corp. Robot system employing force/position control
JP2003294434A (ja) * 2002-03-29 2003-10-15 Ricoh Co Ltd 接触式プローブ
CN110993087A (zh) * 2019-11-06 2020-04-10 上海交通大学 一种远程超声扫描操纵设备及方法
CN111481231A (zh) * 2019-01-29 2020-08-04 昆山华大智造云影医疗科技有限公司 超声检测控制方法、装置、及计算机可读存储介质
CN112472133A (zh) * 2020-12-22 2021-03-12 深圳市德力凯医疗设备股份有限公司 一种超声探头的姿态监控方法及装置
CN112754517A (zh) * 2020-12-30 2021-05-07 中国科学院长春光学精密机械与物理研究所 一种超声检测装置、超声检测方法、超声***
CN113412086A (zh) * 2019-01-29 2021-09-17 昆山华大智造云影医疗科技有限公司 超声扫描控制方法及***、超声扫描设备及存储介质
CN114041828A (zh) * 2022-01-13 2022-02-15 深圳瀚维智能医疗科技有限公司 超声扫查控制方法、机器人及存储介质

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4808063A (en) * 1987-11-03 1989-02-28 Westinghouse Electric Corp. Robot system employing force/position control
JP2003294434A (ja) * 2002-03-29 2003-10-15 Ricoh Co Ltd 接触式プローブ
CN111481231A (zh) * 2019-01-29 2020-08-04 昆山华大智造云影医疗科技有限公司 超声检测控制方法、装置、及计算机可读存储介质
CN113412086A (zh) * 2019-01-29 2021-09-17 昆山华大智造云影医疗科技有限公司 超声扫描控制方法及***、超声扫描设备及存储介质
CN110993087A (zh) * 2019-11-06 2020-04-10 上海交通大学 一种远程超声扫描操纵设备及方法
CN112472133A (zh) * 2020-12-22 2021-03-12 深圳市德力凯医疗设备股份有限公司 一种超声探头的姿态监控方法及装置
CN112754517A (zh) * 2020-12-30 2021-05-07 中国科学院长春光学精密机械与物理研究所 一种超声检测装置、超声检测方法、超声***
CN114041828A (zh) * 2022-01-13 2022-02-15 深圳瀚维智能医疗科技有限公司 超声扫查控制方法、机器人及存储介质

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
Ria Kim等.Robot-Assisted Semi-Autonomous Ultrasound Imaging With Tactile Sensing and Convolutional Neural-Networks.《EEE TRANSACTIONS ON MEDICAL ROBOTICS AND BIONICS》.2021,第3卷(第1期),第96-105页. *
Robot-Assisted Semi-Autonomous Ultrasound Imaging With Tactile Sensing and Convolutional Neural-Networks;Ria Kim等;《EEE TRANSACTIONS ON MEDICAL ROBOTICS AND BIONICS》;20210228;第3卷(第1期);第96-105页 *

Also Published As

Publication number Publication date
CN114748101A (zh) 2022-07-15

Similar Documents

Publication Publication Date Title
US9517563B2 (en) Robot system using visual feedback
CN104249195B (zh) 具备视觉传感器和力传感器的毛刺去除装置
JP5404823B2 (ja) ５軸制御加工機、５軸制御加工機の数値制御装置、数値制御方法、プログラム、ワークの製造方法、金型および成形品
JP6657469B2 (ja) ロボットシステムの自動較正方法
CN105588533B (zh) 形状测定装置以及形状测定方法
JPH07311610A (ja) 視覚センサを用いた座標系設定方法
CN108422420A (zh) 具有学习控制功能的机器人***以及学习控制方法
JP2020078859A (ja) ロボット装置
CN110636923A (zh) 一种机器人的运动控制方法、机器人及控制器
US10549422B2 (en) Robot controller, machine learning device and machine learning method
CN114748101B (zh) 超声扫查控制方法、***及计算机可读存储介质
US10724840B2 (en) Control method of shape measuring apparatus
JP2015085491A (ja) ロボット制御装置、ロボット及びロボット制御方法
JP2013131149A (ja) パラメータ補正方法および制御システム
CN109648563B (zh) 串联机器人运动控制方法及计算机存储介质
US20160356591A1 (en) Method for controlling shape measuring apparatus
JPH02145908A (ja) デジタイジング装置におけるスタイラスのたわみ補正自動設定方法
CN115157272B (zh) 一种基于视觉扫描的自动化编程***
CN114454180B (zh) 移动机器人的运动控制方法、装置和移动机器人
US20230278196A1 (en) Robot system
CN113439013B (zh) 机器人***，机器人的控制装置，以及机器人的控制程序
CN114795289A (zh) 一种血管超声图像视觉伺服的机器人扫描方法及装置
CN114131149A (zh) 一种基于CenterNet的激光视觉焊缝跟踪***、设备及存储介质
US10459425B2 (en) Numerical control device
CN114794668B (zh) 鞋面涂胶方法、***、计算机设备及计算机可读存储介质

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