CN113768535A - 一种遥操作用超声仿型探头姿态自校准方法、系统及装置 - Google Patents

一种遥操作用超声仿型探头姿态自校准方法、系统及装置 Download PDF

Info

Publication number
CN113768535A
CN113768535A CN202110968185.5A CN202110968185A CN113768535A CN 113768535 A CN113768535 A CN 113768535A CN 202110968185 A CN202110968185 A CN 202110968185A CN 113768535 A CN113768535 A CN 113768535A
Authority
CN
China
Prior art keywords
axis
touch pad
ultrasonic
attitude
profiling probe
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
CN202110968185.5A
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.)
Wuhan Cobot Technology Co ltd
Original Assignee
Wuhan Cobot 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 Wuhan Cobot Technology Co ltd filed Critical Wuhan Cobot Technology Co ltd
Priority to CN202110968185.5A priority Critical patent/CN113768535A/zh
Publication of CN113768535A publication Critical patent/CN113768535A/zh
Pending legal-status Critical Current

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/58—Testing, adjusting or calibrating the diagnostic device
    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B8/00—Diagnosis using ultrasonic, sonic or infrasonic waves
    • A61B8/42—Details of probe positioning or probe attachment to the patient
    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B8/00—Diagnosis using ultrasonic, sonic or infrasonic waves
    • A61B8/42—Details of probe positioning or probe attachment to the patient
    • A61B8/4245—Details of probe positioning or probe attachment to the patient involving determining the position of the probe, e.g. with respect to an external reference frame or to the patient
    • A61B8/4254—Details of probe positioning or probe attachment to the patient involving determining the position of the probe, e.g. with respect to an external reference frame or to the patient using sensors mounted on 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/58—Testing, adjusting or calibrating the diagnostic device
    • A61B8/587—Calibration phantoms

Abstract

本发明涉及一种遥操作用超声仿型探头姿态自校准方法、系统及装置，其方法包括，超声仿型探头在触控板上摆动，获取IMU传感器的实时姿态数据和触控板感应的实时平移数据；将实时姿态数据转换成欧拉角形式；根据实时平移数据计算出平移方向向量；根据欧拉角形式的实时姿态数据以及平移方向向量判断出摆动轴、摆动方向以及平移方向向量所在的象限；利用摆动轴、摆动方向以及平移方向向量所在的象限对应的姿态校准模型，对IMU传感器的航向角进行自校准。本发明可以对IMU传感器的航向角的漂移进行抑制，从而保证了使超声仿型探头到机器人末端超声探头的位置和姿态映射精度，进而提高了获取的超声图像质量。

Description

一种遥操作用超声仿型探头姿态自校准方法、系统及装置
技术领域
本发明涉及超声探头校准领域，具体涉及一种遥操作用超声仿型探头姿态自校准方法、系统及装置。
背景技术
在机器人超声扫描的遥操作中，医生在工作室拿着内嵌有IMU传感器的超声仿型探头，通过网络传输，来控制机器人端超声探头的工作。内嵌有IMU传感器的超声仿型探头到机器人末端超声探头的位置和姿态映射精度对获取清晰的超声图像质量至关重要。而在实际应用过程中，由于IMU传感器绕Z轴的旋转角是不准确的，但是绕X轴和Y轴的旋转角是准确的，就相当于将超声仿型探头吊在空中，其方向一直无法确定，因此会造成IMU传感器的航向角发生漂移，从而会造成超声仿型探头到机器人末端超声探头的位置和姿态映射精度下降，进而影响到获取的超声图像质量不佳。
发明内容
本发明所要解决的技术问题是提供一种遥操作用超声仿型探头姿态自校准方法、系统及装置，可以对IMU传感器的航向角的漂移进行抑制，从而保证了使超声仿型探头到机器人末端超声探头的位置和姿态映射精度，进而提高了获取的超声图像质量。
本发明解决上述技术问题的技术方案如下：一种遥操作用超声仿型探头姿态自校准方法，用于校准内嵌有IMU传感器的超声仿型探头通过圆弧状末端在触控板上摆动时IMU传感器的航向角，包括如下步骤，
S1，将所述超声仿型探头的圆弧状末端接触所述触控板，并使所述超声仿型探头在所述触控板上摆动，获取所述IMU传感器在IMU坐标系下的实时姿态数据和所述触控板感应的在触控板坐标系下的实时平移数据；其中，所述IMU传感器在IMU坐标系下的实时姿态数据的数据形式具体为姿态四元数形式；
S2，将所述IMU传感器在IMU坐标系下的姿态四元数形式的实时姿态数据转换成欧拉角形式的实时姿态数据；根据所述触控板感应的在触控板坐标系下的实时平移数据，计算出所述超声仿型探头在所述触控板上摆动时的平移方向向量；
S3，根据所述IMU传感器的欧拉角形式的实时姿态数据以及所述超声仿型探头在所述触控板上摆动时的平移方向向量，判断出所述超声仿型探头在所述触控板上摆动时的摆动轴、摆动方向以及所述平移方向向量所在的象限；
S4，利用所述超声仿型探头在所述触控板上摆动时的摆动轴、摆动方向以及所述平移方向向量所在的象限共同对应的姿态校准模型，对所述IMU传感器的航向角进行自校准。
基于上述一种遥操作用超声仿型探头姿态自校准方法，本发明还提供一种遥操作用超声仿型探头姿态自校准系统。
一种遥操作用超声仿型探头姿态自校准系统，用于校准内嵌有IMU传感器的超声仿型探头通过圆弧状末端在触控板上摆动时IMU传感器的航向角，包括如下模块，
姿态数据及平移数据获取模块，其用于在所述超声仿型探头的圆弧状末端接触所述触控板，且所述超声仿型探头在所述触控板上摆动时，获取所述IMU传感器在IMU坐标系下的实时姿态数据和所述触控板感应的在触控板坐标系下的实时平移数据；其中，所述IMU传感器在IMU坐标系下的实时姿态数据的数据形式具体为姿态四元数形式；
数据变换模块，其用于将所述IMU传感器在IMU坐标系下的姿态四元数形式的实时姿态数据转换成欧拉角形式的实时姿态数据；根据所述触控板感应的在触控板坐标系下的实时平移数据，计算出所述超声仿型探头在所述触控板上摆动时的平移方向向量；
摆动参数计算模块，其用于根据所述IMU传感器的欧拉角形式的实时姿态数据以及所述超声仿型探头在所述触控板上摆动时的平移方向向量，判断出所述超声仿型探头在所述触控板上摆动时的摆动轴、摆动方向以及所述平移方向向量所在的象限；
姿态校准模块，其用于利用所述超声仿型探头在所述触控板上摆动时的摆动轴、摆动方向以及所述平移方向向量所在的象限共同对应的姿态校准模型，对所述IMU传感器的航向角进行自校准。
基于上述一种遥操作用超声仿型探头姿态自校准方法，本发明还提供一种计算机存储介质。
一种计算机存储介质，包括存储器以及存储在所述存储器内的计算机程序，所述计算机程序被计算机处理器执行时用于实现如上述所述的遥操作用超声仿型探头姿态自校准方法。
基于上述一种计算机存储介质，本发明还提供一种遥操作用超声仿型探头姿态自校准装置。
一种遥操作用超声仿型探头姿态自校准装置，包括机壳，所述机壳内安装有工控机，所述机壳表面安装有显示屏和触控板，所述触控板上配置有可移动的超声仿型探头；所述工控机内安装有如上述所述的计算机存储介质，所述显示屏以及所述触控板均与所述工控机电连接。
本发明的有益效果是：在本发明一种遥操作用超声仿型探头姿态自校准方法、系统及装置中，超声仿型探头的圆弧状末端在触控板上摆动时会形成一条直线轨迹，该直线在触控板坐标系平面内的方向即可表示超声仿型探头绕Z轴的旋转角度，也就是IMU传感器的航向角；因此，本发明利用超声仿型探头的结构特点，根据超声仿型探头在触控板上摆动时形成的直线方向来校准IMU传感器的航向角，实现对IMU航向漂移的自动消除，从而保证了使超声仿型探头到机器人末端超声探头的位置和姿态映射精度，进而提高了获取的超声图像质量。
附图说明
图1为本发明一种遥操作用超声仿型探头姿态自校准方法的流程框图；
图2为超声仿型探头接触触控板时的状态图；
图3为超声仿型探头在触控板上摆动的一种状态图；
图4为本发明一种遥操作用超声仿型探头姿态自校准方法的原理框图；
图5(a)为俯视的声仿型探头绕各轴旋转的方向坐标示意图；
图5(b)为后视的超声仿型探头绕X轴旋转的示意图；
图5(c)为侧视的超声仿型探头绕Y轴旋转的示意图；
图6为本发明一种遥操作用超声仿型探头姿态自校准系统的结构框图；
图7为本发明一种遥操作用超声仿型探头姿态自校准装置的结构示意图。
附图中，各标号所代表的部件列表如下：
1、超声仿型探头，2、触控板。
具体实施方式
以下结合附图对本发明的原理和特征进行描述，所举实例只用于解释本发明，并非用于限定本发明的范围。
如图1所示，一种遥操作用超声仿型探头姿态自校准方法，用于校准内嵌有IMU传感器的超声仿型探头通过圆弧状末端在触控板上摆动时IMU传感器的航向角，包括如下步骤，
S1，将所述超声仿型探头的圆弧状末端接触所述触控板，并使所述超声仿型探头在所述触控板上摆动，获取所述IMU传感器在IMU坐标系下的实时姿态数据和所述触控板感应的在触控板坐标系下的实时平移数据；其中，所述IMU传感器在IMU坐标系下的实时姿态数据的数据形式具体为姿态四元数形式；
S2，将所述IMU传感器在IMU坐标系下的姿态四元数形式的实时姿态数据转换成欧拉角形式的实时姿态数据；根据所述触控板感应的在触控板坐标系下的实时平移数据，计算出所述超声仿型探头在所述触控板上摆动时的平移方向向量；
S3，根据所述IMU传感器的欧拉角形式的实时姿态数据以及所述超声仿型探头在所述触控板上摆动时的平移方向向量，判断出所述超声仿型探头在所述触控板上摆动时的摆动轴、摆动方向以及所述平移方向向量所在的象限；
S4，利用所述超声仿型探头在所述触控板上摆动时的摆动轴、摆动方向以及所述平移方向向量所在的象限共同对应的姿态校准模型，对所述IMU传感器的航向角进行自校准。
在本具体实施例中，如图2和图3所示：将超声仿型探头1的圆弧状末端接触触控板2，超声仿型探头1接触触控板2时的状态如图2所示，XY坐标系代表触控板坐标系，XYZ坐标系代表IMU坐标系；使超声仿型探头1在触控板2上摆动，超声仿型探头1在触控板2上摆动的一种状态如图3所示，直线箭头代表摆动形成的直线轨迹，弧形箭头代表摆动方向。在触控板上原地旋转超声仿型探头时，超声仿型探头末端圆弧部分会在触控板上形成一条直线轨迹，该直线在触控板坐标系平面内的方向即表示仿型探头绕Z轴的旋转角度，也就是IMU的航向角。因此，我们可以根据仿型探头在触控板上摆动时形成的直线方向，校准IMU的航向角，实现对IMU航向漂移的自动消除。
图4为本发明一种遥操作用超声仿型探头姿态自校准方法的原理框图；在本具体实施例中：
所述超声仿型探头在所述触控板上摆动时的摆动轴为X轴、Y轴和多轴中的一种；其中，所述超声仿型探头在所述触控板上摆动时的摆动轴为X轴，表征所述超声仿型探头在所述触控板上绕X轴摆动，所述超声仿型探头在所述触控板上摆动时的摆动轴为Y轴，表征所述超声仿型探头在所述触控板上绕Y轴摆动，所述超声仿型探头在所述触控板上摆动时的摆动轴为多轴，表征所述超声仿型探头在所述触控板上绕除X轴以及Y轴以外的轴摆动；所述超声仿型探头在所述触控板上摆动时的摆动方向包括正向和负向；所述超声仿型探头在所述触控板上摆动时的所述平移方向向量所在的象限包括14象限和23象限。
图5(a)为俯视的超声仿型探头绕各轴旋转的方向坐标示意图，图5(b)为后视的超声仿型探头绕X轴旋转的示意图，图5(c)为侧视的超声仿型探头绕Y轴旋转的示意图；结合图5(a)、图5(b)和图5(c)，可以得出如下所述超声仿型探头在所述触控板上摆动时的摆动轴、摆动方向以及所述平移方向向量所在的象限共同对应的姿态校准模型。
具体的，所述超声仿型探头在所述触控板上摆动时的摆动轴、摆动方向以及所述平移方向向量所在的象限共同对应的姿态校准模型包括X轴负向14象限姿态校准模型、X轴负向23象限姿态校准模型、X轴正向14象限姿态校准模型、X轴正向23象限姿态校准模型、Y轴负向14象限姿态校准模型、Y轴负向23象限姿态校准模型、Y轴正向14象限姿态校准模型、Y轴正向23象限姿态校准模型和多轴姿态校准模型。
在本具体实施例中：
所述X轴负向14象限姿态校准模型为，Q(t)＝-acos[(dy(t)/D]；
所述X轴负向23象限姿态校准模型为，Q(t)＝acos[(dy(t)/D]；
所述X轴正向14象限姿态校准模型为，Q(t)＝π-acos[(dy(t)/D]；
所述X轴正向23象限姿态校准模型为，Q(t)＝acos[(dy(t)/D]-π；
所述Y轴负向14象限姿态校准模型为，Q(t)＝-acos[(dy(t)/D]-π/2；
所述Y轴负向23象限姿态校准模型为，Q(t)＝acos[(dy(t)/D]-π/2；
所述Y轴正向14象限姿态校准模型为，Q(t)＝-acos[(dy(t)/D]+π/2；
所述Y轴正向23象限姿态校准模型为，Q(t)＝acos[(dy(t)/D]+π/2；
其中，Q(t)为t时刻IMU传感器的航向角自校准后的角度(具体的，Q(t)为通过姿态校准模型计算得到的真实的航向角，姿态校准模型就是需要将IMU传感器输出的航向角校准为这个值)；D＝sqrt[dx(t)*dx(t)+dy(t)*dy(t)]，dx(t)和dy(t)分别为所述超声仿型探头在所述触控板上摆动时t时刻的平移方向向量中的平移方向X轴分量和平移方向Y轴分量，dx(t)＝x(t)-x(t-1)，dy(t)＝y(t)-y(t-1)，x(t)和y(t)分别为所述触控板感应的在触控板坐标系下t时刻的平移数据中的X轴分量和Y轴分量；acos()为反余弦函数，π为圆周率。
在本具体实施例中：
当所述超声仿型探头在所述触控板上绕除X轴以及Y轴以外的轴摆动时，先将超声仿型探头的多轴摆动进行分解，分解成绕X轴摆动以及绕Y轴摆动，然后根据X轴对应的姿态校准模型以及Y轴对应的姿态校准模型对所述IMU传感器的航向角综合进行自校准；
其中，X轴对应的姿态校准模型为X轴负向14象限姿态校准模型或X轴负向23象限姿态校准模型或X轴正向14象限姿态校准模型或X轴正向23象限姿态校准模型；Y轴对应的姿态校准模型为Y轴负向14象限姿态校准模型或Y轴负向23象限姿态校准模型或Y轴正向14象限姿态校准模型或Y轴正向23象限姿态校准模型。
在本具体实施例中：
在所述S1后，还包括如下步骤，
根据所述IMU传感器在IMU坐标系下的实时姿态数据和所述触控板感应的在触控板坐标系下的实时平移数据，判断所述超声仿型探头在所述触控板上摆动的同时是否存在平移操作；若是，则停止对所述IMU传感器的航向角进行自校准的过程并结束；若否，则依次执行所述S2至所述S4。
具体的，IMU传感器的航向角进行自校准的基本思路是根据超声仿型探头圆弧状末端在触控板上摆动形成的直线轨迹来校准航向角漂移的。但当摆动探头的同时进行平移操作时，从触控板获取的方向向量就不能表示超声仿型探头Z轴的旋转角了；此时，就需要对这些平移和旋转同时存在的场景进行判断，以避免误触IMU自动校准。
在操作超声仿型探头时，可能会出现的IMU自动校准误触的操作包括：
1.旋转方向和平移方向相反，即向前平移，但向后摆动；这样会造成计算的IMU航向角与真实航向角差180°。考虑到实际IMU传感器不会突然漂移180°，因此对于这种情况，可通过约束航向角的最大漂移度数来解决。
2.旋转方向和平移方向存在一定夹角(实际中比较难实现)，即往一个方向旋转同时往一个比较偏的方向平移。这样最多会造成90°的偏差。旋转方向和平移方向存在一定夹角，会造成根据旋转角计算出来的平移距离小于触控板测得的真实平移距离，根据该原则可对该类情况进行过滤。
基于上述一种遥操作用超声仿型探头姿态自校准方法，本发明还提供一种遥操作用超声仿型探头姿态自校准系统。
如图6所示，一种遥操作用超声仿型探头姿态自校准系统，用于校准内嵌有IMU传感器的超声仿型探头通过圆弧状末端在触控板上摆动时IMU传感器的航向角，包括如下模块，
姿态数据及平移数据获取模块，其用于在所述超声仿型探头的圆弧状末端接触所述触控板，且所述超声仿型探头在所述触控板上摆动时，获取所述IMU传感器在IMU坐标系下的实时姿态数据和所述触控板感应的在触控板坐标系下的实时平移数据；其中，所述IMU传感器在IMU坐标系下的实时姿态数据的数据形式具体为姿态四元数形式；
数据变换模块，其用于将所述IMU传感器在IMU坐标系下的姿态四元数形式的实时姿态数据转换成欧拉角形式的实时姿态数据；根据所述触控板感应的在触控板坐标系下的实时平移数据，计算出所述超声仿型探头在所述触控板上摆动时的平移方向向量；
摆动参数计算模块，其用于根据所述IMU传感器的欧拉角形式的实时姿态数据以及所述超声仿型探头在所述触控板上摆动时的平移方向向量，判断出所述超声仿型探头在所述触控板上摆动时的摆动轴、摆动方向以及所述平移方向向量所在的象限；
姿态校准模块，其用于利用所述超声仿型探头在所述触控板上摆动时的摆动轴、摆动方向以及所述平移方向向量所在的象限共同对应的姿态校准模型，对所述IMU传感器的航向角进行自校准。
基于上述一种遥操作用超声仿型探头姿态自校准方法，本发明还提供一种计算机存储介质。
一种计算机存储介质，包括存储器以及存储在所述存储器内的计算机程序，所述计算机程序被计算机处理器执行时用于实现如上述所述的遥操作用超声仿型探头姿态自校准方法。
基于上述一种计算机存储介质，本发明还提供一种遥操作用超声仿型探头姿态自校准装置。
如图7所示，一种遥操作用超声仿型探头姿态自校准装置，包括机壳，所述机壳内安装有工控机，所述机壳表面安装有触控板2，所述触控板2上配置有可移动的超声仿型探头1；所述工控机内安装有如上述所述的计算机存储介质，所述触控板2与所述工控机电连接。
在本具体实施例中，机壳表面还配置有显示屏，显示屏与工控机电连接，用于显示超声图像。
在本具体实施例中，工控机通过网络与远程的机器人连接并通信，机器人末端固定超声探头，工控机通过获取超声仿型探头在触控板上移动的数据信息控制远程的机器人带动末端的超声探头工作；而在超声仿型探头在触控板上移动时，通过本发明的姿态自校准方法可以保证超声仿型探头到机器人末端超声探头的位置和姿态映射精度，进而提高了获取的超声图像质量。
在本发明一种遥操作用超声仿型探头姿态自校准方法、系统及装置中，超声仿型探头的圆弧状末端在触控板上摆动时会形成一条直线轨迹，该直线在触控板坐标系平面内的方向即可表示超声仿型探头绕Z轴的旋转角度，也就是IMU传感器的航向角；因此，本发明利用超声仿型探头的结构特点，根据超声仿型探头在触控板上摆动时形成的直线方向来校准IMU传感器的航向角，实现对IMU航向漂移的自动消除，从而保证了超声仿型探头到机器人末端超声探头的位置和姿态映射精度，进而提高了获取的超声图像质量。
以上所述仅为本发明的较佳实施例，并不用以限制本发明，凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。

Claims (10)

1.一种遥操作用超声仿型探头姿态自校准方法，其特征在于：用于校准内嵌有IMU传感器的超声仿型探头通过圆弧状末端在触控板上摆动时IMU传感器的航向角，包括如下步骤，
S1，将所述超声仿型探头的圆弧状末端接触所述触控板，并使所述超声仿型探头在所述触控板上摆动，获取所述IMU传感器在IMU坐标系下的实时姿态数据和所述触控板感应的在触控板坐标系下的实时平移数据；其中，所述IMU传感器在IMU坐标系下的实时姿态数据的数据形式具体为姿态四元数形式；
S2，将所述IMU传感器在IMU坐标系下的姿态四元数形式的实时姿态数据转换成欧拉角形式的实时姿态数据；根据所述触控板感应的在触控板坐标系下的实时平移数据，计算出所述超声仿型探头在所述触控板上摆动时的平移方向向量；
S3，根据所述IMU传感器的欧拉角形式的实时姿态数据以及所述超声仿型探头在所述触控板上摆动时的平移方向向量，判断出所述超声仿型探头在所述触控板上摆动时的摆动轴、摆动方向以及所述平移方向向量所在的象限；
S4，利用所述超声仿型探头在所述触控板上摆动时的摆动轴、摆动方向以及所述平移方向向量所在的象限共同对应的姿态校准模型，对所述IMU传感器的航向角进行自校准。
2.根据权利要求1所述的遥操作用超声仿型探头姿态自校准方法，其特征在于：所述超声仿型探头在所述触控板上摆动时的摆动轴为X轴、Y轴和多轴中的一种；其中，所述超声仿型探头在所述触控板上摆动时的摆动轴为X轴，表征所述超声仿型探头在所述触控板上绕X轴摆动，所述超声仿型探头在所述触控板上摆动时的摆动轴为Y轴，表征所述超声仿型探头在所述触控板上绕Y轴摆动，所述超声仿型探头在所述触控板上摆动时的摆动轴为多轴，表征所述超声仿型探头在所述触控板上绕除X轴以及Y轴以外的轴摆动；
所述超声仿型探头在所述触控板上摆动时的摆动方向包括正向和负向；
所述超声仿型探头在所述触控板上摆动时的所述平移方向向量所在的象限包括14象限和23象限。
3.根据权利要求2所述的遥操作用超声仿型探头姿态自校准方法，其特征在于：所述超声仿型探头在所述触控板上摆动时的摆动轴、摆动方向以及所述平移方向向量所在的象限共同对应的姿态校准模型包括X轴负向14象限姿态校准模型、X轴负向23象限姿态校准模型、X轴正向14象限姿态校准模型、X轴正向23象限姿态校准模型、Y轴负向14象限姿态校准模型、Y轴负向23象限姿态校准模型、Y轴正向14象限姿态校准模型、Y轴正向23象限姿态校准模型和多轴姿态校准模型。
4.根据权利要求3所述的遥操作用超声仿型探头姿态自校准方法，其特征在于：
所述X轴负向14象限姿态校准模型为，Q(t)＝-acos[(dy(t)/D]，
所述X轴负向23象限姿态校准模型为，Q(t)＝acos[(dy(t)/D]，
所述X轴正向14象限姿态校准模型为，Q(t)＝π-acos[(dy(t)/D]，
所述X轴正向23象限姿态校准模型为，Q(t)＝acos[(dy(t)/D]-π；
其中，Q(t)为t时刻IMU传感器的航向角自校准后的角度；D＝sqrt[dx(t)*dx(t)+dy(t)*dy(t)]，dx(t)和dy(t)分别为所述超声仿型探头在所述触控板上摆动时t时刻的平移方向向量中的平移方向X轴分量和平移方向Y轴分量，dx(t)＝x(t)-x(t-1)，dy(t)＝y(t)-y(t-1)，x(t)和y(t)分别为所述触控板感应的在触控板坐标系下t时刻的平移数据中的X轴分量和Y轴分量；acos()为反余弦函数，π为圆周率。
5.根据权利要求3所述的遥操作用超声仿型探头姿态自校准方法，其特征在于：
所述Y轴负向14象限姿态校准模型为，Q(t)＝-acos[(dy(t)/D]-π/2，
所述Y轴负向23象限姿态校准模型为，Q(t)＝acos[(dy(t)/D]-π/2，
所述Y轴正向14象限姿态校准模型为，Q(t)＝-acos[(dy(t)/D]+π/2，
所述Y轴正向23象限姿态校准模型为，Q(t)＝acos[(dy(t)/D]+π/2；
其中，Q(t)为t时刻IMU传感器的航向角自校准后的角度；D＝sqrt[dx(t)*dx(t)+dy(t)*dy(t)]，dx(t)和dy(t)分别为所述超声仿型探头在所述触控板上摆动时t时刻的平移方向向量中的平移方向X轴分量和平移方向Y轴分量，dx(t)＝x(t)-x(t-1)，dy(t)＝y(t)-y(t-1)，x(t)和y(t)分别为所述触控板感应的在触控板坐标系下t时刻的平移数据中的X轴分量和Y轴分量；acos()为反余弦函数，π为圆周率。
6.根据权利要求3至5任一项所述的遥操作用超声仿型探头姿态自校准方法，其特征在于：当所述超声仿型探头在所述触控板上绕除X轴以及Y轴以外的轴摆动时，先将超声仿型探头的多轴摆动进行分解，分解成绕X轴摆动以及绕Y轴摆动，然后根据X轴对应的姿态校准模型以及Y轴对应的姿态校准模型对所述IMU传感器的航向角综合进行自校准；
其中，X轴对应的姿态校准模型为X轴负向14象限姿态校准模型或X轴负向23象限姿态校准模型或X轴正向14象限姿态校准模型或X轴正向23象限姿态校准模型；Y轴对应的姿态校准模型为Y轴负向14象限姿态校准模型或Y轴负向23象限姿态校准模型或Y轴正向14象限姿态校准模型或Y轴正向23象限姿态校准模型。
7.根据权利要求1至5任一项所述的遥操作用超声仿型探头姿态自校准方法，其特征在于：在所述S1后，还包括如下步骤，
根据所述IMU传感器在IMU坐标系下的实时姿态数据和所述触控板感应的在触控板坐标系下的实时平移数据，判断所述超声仿型探头在所述触控板上摆动的同时是否存在平移操作；若是，则停止对所述IMU传感器的航向角进行自校准的过程并结束；若否，则依次执行所述S2至所述S4。
8.一种遥操作用超声仿型探头姿态自校准系统，其特征在于：用于校准内嵌有IMU传感器的超声仿型探头通过圆弧状末端在触控板上摆动时IMU传感器的航向角，包括如下模块，
姿态数据及平移数据获取模块，其用于在所述超声仿型探头的圆弧状末端接触所述触控板，且所述超声仿型探头在所述触控板上摆动时，获取所述IMU传感器在IMU坐标系下的实时姿态数据和所述触控板感应的在触控板坐标系下的实时平移数据；其中，所述IMU传感器在IMU坐标系下的实时姿态数据的数据形式具体为姿态四元数形式；
数据变换模块，其用于将所述IMU传感器在IMU坐标系下的姿态四元数形式的实时姿态数据转换成欧拉角形式的实时姿态数据；根据所述触控板感应的在触控板坐标系下的实时平移数据，计算出所述超声仿型探头在所述触控板上摆动时的平移方向向量；
摆动参数计算模块，其用于根据所述IMU传感器的欧拉角形式的实时姿态数据以及所述超声仿型探头在所述触控板上摆动时的平移方向向量，判断出所述超声仿型探头在所述触控板上摆动时的摆动轴、摆动方向以及所述平移方向向量所在的象限；
姿态校准模块，其用于利用所述超声仿型探头在所述触控板上摆动时的摆动轴、摆动方向以及所述平移方向向量所在的象限共同对应的姿态校准模型，对所述IMU传感器的航向角进行自校准。
9.一种计算机存储介质，其特征在于：包括存储器以及存储在所述存储器内的计算机程序，所述计算机程序被计算机处理器执行时用于实现如权利要求1至7任一项所述的遥操作用超声仿型探头姿态自校准方法。
10.一种遥操作用超声仿型探头姿态自校准装置，其特征在于：包括机壳，所述机壳内安装有工控机，所述机壳表面安装有触控板，所述触控板上配置有可移动的超声仿型探头；所述工控机内安装有如权利要求9所述的计算机存储介质，所述触控板与所述工控机电连接。
CN202110968185.5A 2021-08-23 2021-08-23 一种遥操作用超声仿型探头姿态自校准方法、系统及装置 Pending CN113768535A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110968185.5A CN113768535A (zh) 2021-08-23 2021-08-23 一种遥操作用超声仿型探头姿态自校准方法、系统及装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110968185.5A CN113768535A (zh) 2021-08-23 2021-08-23 一种遥操作用超声仿型探头姿态自校准方法、系统及装置

Publications (1)

Publication Number Publication Date
CN113768535A true CN113768535A (zh) 2021-12-10

Family

ID=78838880

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110968185.5A Pending CN113768535A (zh) 2021-08-23 2021-08-23 一种遥操作用超声仿型探头姿态自校准方法、系统及装置

Country Status (1)

Country Link
CN (1) CN113768535A (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114714349A (zh) * 2022-03-23 2022-07-08 武汉库柏特科技有限公司 一种遥操作超声扫描机器人姿态测试方法、装置及设备

Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CA2253634A1 (en) * 1996-05-06 1997-11-13 Biosense, Inc. Radiator calibration
FR2808084A1 (fr) * 2000-04-21 2001-10-26 Thomson Marconi Sonar Sas Dispositif de mesure d'assiette et de cap
US20050111725A1 (en) * 2003-11-25 2005-05-26 Mitutoyo Corporation Surface scan measuring device and method of forming compensation table for scanning probe
WO2005099581A1 (en) * 2004-04-15 2005-10-27 Johns Hopkins University Ultrasound calibration and real-time quality assurance based on closed form formulation
US20060036170A1 (en) * 2004-07-20 2006-02-16 Martin Lachaine Calibrating imaging devices
US20080287787A1 (en) * 2006-02-02 2008-11-20 Frank Sauer Line-based calibration of ultrasound transducer integrated with a pose sensor
WO2013001424A2 (en) * 2011-06-27 2013-01-03 Koninklijke Philips Electronics N.V. Ultrasound-image-guide system and volume-motion-base calibration method
CN104391131A (zh) * 2014-11-20 2015-03-04 陕西师范大学 一种基于Zigbee网络的方向自校准超声波测风系统及方法
WO2017036044A1 (zh) * 2015-09-01 2017-03-09 中国科学院深圳先进技术研究院 一种超声探头标定体模、超声探头标定系统及其标定方法
CN109567865A (zh) * 2019-01-23 2019-04-05 上海浅葱网络技术有限公司 一种面向非医护人员的智能超声诊断设备
CN113116386A (zh) * 2019-12-31 2021-07-16 无锡祥生医疗科技股份有限公司 超声成像引导方法、超声设备及存储介质

Patent Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CA2253634A1 (en) * 1996-05-06 1997-11-13 Biosense, Inc. Radiator calibration
FR2808084A1 (fr) * 2000-04-21 2001-10-26 Thomson Marconi Sonar Sas Dispositif de mesure d'assiette et de cap
US20050111725A1 (en) * 2003-11-25 2005-05-26 Mitutoyo Corporation Surface scan measuring device and method of forming compensation table for scanning probe
WO2005099581A1 (en) * 2004-04-15 2005-10-27 Johns Hopkins University Ultrasound calibration and real-time quality assurance based on closed form formulation
US20060036170A1 (en) * 2004-07-20 2006-02-16 Martin Lachaine Calibrating imaging devices
US20080287787A1 (en) * 2006-02-02 2008-11-20 Frank Sauer Line-based calibration of ultrasound transducer integrated with a pose sensor
WO2013001424A2 (en) * 2011-06-27 2013-01-03 Koninklijke Philips Electronics N.V. Ultrasound-image-guide system and volume-motion-base calibration method
CN104391131A (zh) * 2014-11-20 2015-03-04 陕西师范大学 一种基于Zigbee网络的方向自校准超声波测风系统及方法
WO2017036044A1 (zh) * 2015-09-01 2017-03-09 中国科学院深圳先进技术研究院 一种超声探头标定体模、超声探头标定系统及其标定方法
CN109567865A (zh) * 2019-01-23 2019-04-05 上海浅葱网络技术有限公司 一种面向非医护人员的智能超声诊断设备
CN113116386A (zh) * 2019-12-31 2021-07-16 无锡祥生医疗科技股份有限公司 超声成像引导方法、超声设备及存储介质

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114714349A (zh) * 2022-03-23 2022-07-08 武汉库柏特科技有限公司 一种遥操作超声扫描机器人姿态测试方法、装置及设备
CN114714349B (zh) * 2022-03-23 2024-04-16 武汉库柏特科技有限公司 一种遥操作超声扫描机器人姿态测试方法、装置及设备

Similar Documents

Publication Publication Date Title
JP4191080B2 (ja) 計測装置
CN107428009B (zh) 用于工业机器人调试的方法、使用该方法的工业机器人系统和控制系统
JP4021413B2 (ja) 計測装置
WO2021128787A1 (zh) 一种定位的方法及装置
JP5670416B2 (ja) ロボットシステム表示装置
CN110640747B (zh) 机器人的手眼标定方法、系统、电子设备和存储介质
KR20140008262A (ko) 로봇 시스템, 로봇, 로봇 제어 장치, 로봇 제어 방법 및 로봇 제어 프로그램
CN113021358B (zh) 机械臂工具坐标系原点标定方法、装置和电子设备
US11059181B2 (en) Control apparatus, robot, and robot system
JP2019042834A (ja) 制御装置およびロボットシステム
CN113211445B (zh) 一种机器人参数标定方法、装置、设备及存储介质
JPWO2018043524A1 (ja) ロボットシステム、ロボットシステム制御装置、およびロボットシステム制御方法
CN113768535A (zh) 一种遥操作用超声仿型探头姿态自校准方法、系统及装置
TW201313415A (zh) 機械手臂的座標校正系統及方法
WO2023165355A1 (zh) 手术平台定位系统、位姿信息确定方法以及装置
US11158080B2 (en) Information processing method, information processing device, object detection apparatus, and robot system
CN115272410A (zh) 一种无标定视觉的动态目标追踪方法、装置、设备及介质
CN109664273B (zh) 一种工业机器人光标拖动示教方法及系统
JP2022031083A (ja) 情報処理方法、情報処理システム、プログラム
CN114930259A (zh) 用于校准的方法和电子设备、系统和计算机可读介质
CN111043959A (zh) 基于光学定位仪的工具尖端位置的动态标定方法、系统、介质、设备
CN114750153B (zh) 机器人机械臂的运动控制系统、协作机器人及存储介质
CN111971529A (zh) 用于管理机器人系统的方法和装置
JP2021010994A (ja) センサ位置姿勢キャリブレーション装置及びセンサ位置姿勢キャリブレーション方法
CN108422436A (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