热敏灸机器人位姿确定方法、系统、存储介质及计算机技术方案

本发明专利技术提供一种热敏灸机器人位姿确定方法、系统、存储介质及计算机，在热敏灸机器人的操作头上安装有多个激光传感器，该方法包括：分别采集各激光传感器与人体体表目标穴位的第一距离数据；根据基于操作头定义的随体坐标系和第一距离数据获取各激光传感器的激光光点的坐标值及操作头上艾条的坐标值；根据各激光光点的坐标值计算出各激光光点所形成的最佳平面的单位法向量，利用最佳平面的单位法向量和定义的操作头的单位向量计算出操作头相对于最佳平面的姿态角；根据艾条的坐标值计算出艾条距离最佳平面的第二距离数据和姿态角确定热敏灸机器人的位姿。本发明专利技术通过表征目标穴位的最佳平面方程来计算出的操作头姿态角和目标距离更加准确。和目标距离更加准确。和目标距离更加准确。

【技术实现步骤摘要】
热敏灸机器人位姿确定方法、系统、存储介质及计算机


[0001]本专利技术涉及医疗设备
，特别涉及一种热敏灸机器人位姿确定方法、系统、存储介质及计算机。

技术介绍

[0002]热敏灸是针灸的一种，是指用大剂量的艾灸长时间作用于人体的某些穴位，当艾灸效应累积到一定程度时在针灸艾灸部位会产生特别敏化现象，起到治病保健的效果。为了推广热敏灸技术，开发了热敏灸机器人，艾条安装于机器人的操作头上。
[0003]现有的热敏灸机器人操作头上设计有1~3个激光传感，布置于艾条四周，呈正三角形排列，激光传感的光轴与艾条的中心轴线保持平行，主要用于测量艾条头部距人体表面穴位的竖向距离，并不用于计算相对姿态。此外，受限与艾条和激光传感的空间尺寸，按照上述平行布置的激光传感，其投射在人体皮肤表面的光点之间距离太远，非常不利于操作头针对人体目标穴位的定位和距离测量，比如人体的胳膊、手臂、后背等部位，极大限制了机器人操作头的使用范围。

技术实现思路

[0004]基于此，本专利技术的目的是提供一种热敏灸机器人位姿确定方法、系统、存储介质及计算机，以至少解决上述相关技术中的不足。
[0005]本专利技术提出一种热敏灸机器人位姿确定方法，在所述热敏灸机器人的操作头上安装有多个激光传感器，包括：以预设的采样频率分别采集各所述激光传感器与人体体表目标穴位的第一距离数据；基于所述操作头定义随体坐标系，并根据所述随体坐标系和所述第一距离数据获取各所述激光传感器的激光光点的坐标值以及所述操作头上艾条的坐标值；根据各所述激光光点的坐标值计算出各所述激光光点所形成的最佳平面的单位法向量，定义所述操作头的单位向量，并利用所述最佳平面的单位法向量和所述操作头的单位向量计算出所述操作头相对于所述最佳平面的姿态角；根据所述艾条的坐标值计算出所述艾条距离所述最佳平面的第二距离数据，并根据所述第二距离数据和所述姿态角确定所述热敏灸机器人的位姿。
[0006]进一步的，各所述激光传感器的激光光点聚焦于所述艾条的中心轴线上、且所述激光传感器的数量N≥3。
[0007]进一步的，根据各所述激光光点的坐标值计算出各所述激光光点所形成的最佳平面的单位法向量的步骤包括：利用最小二乘法对各所述激光光点的坐标值进行拟合，以得到各所述激光光点所形成的最佳平面的平面方程；利用所述最佳平面的平面方程按照第一公式计算出其对应的单位法向量。
[0008]进一步的，所述最佳平面的平面方程的表达式为：AX+BY+ CZ+D=0；所述最佳平面的单位法向量的计算公式为：；式中，n表示最佳平面的单位法向量。
[0009]进一步的，所述第二距离数据的计算公式为：；式中，艾条的坐标值为（X0，Y0，Z0）。
[0010]本专利技术还提出一种热敏灸机器人位姿确定系统，在所述热敏灸机器人的操作头上安装有多个激光传感器，包括：数据采集模块，用于以预设的采样频率分别采集各所述激光传感器与人体体表目标穴位的第一距离数据；坐标值计算模块，用于基于所述操作头定义随体坐标系，并根据所述随体坐标系和所述第一距离数据获取各所述激光传感器的激光光点的坐标值以及所述操作头上艾条的坐标值；姿态角计算模块，用于根据各所述激光光点的坐标值计算出各所述激光光点所形成的最佳平面的单位法向量，定义所述操作头的单位向量，并利用所述最佳平面的单位法向量和所述操作头的单位向量计算出所述操作头相对于所述最佳平面的姿态角；位姿确定模块，用于根据所述艾条的坐标值计算出所述艾条距离所述最佳平面的第二距离数据，并根据所述第二距离数据和所述姿态角确定所述热敏灸机器人的位姿。
[0011]进一步的，所述姿态角计算模块包括：平面方程计算单元，用于利用最小二乘法对各所述激光光点的坐标值进行拟合，以得到各所述激光光点所形成的最佳平面的平面方程；法向量计算单元，用于利用所述最佳平面的平面方程按照第一公式计算出其对应的单位法向量。
[0012]本专利技术还提出一种存储介质，其上存储有计算机程序，该计算机程序被处理器执行时实现上述的热敏灸机器人位姿确定方法。
[0013]本专利技术还提出一种计算机，包括存储器、处理器以及存储在所述存储器上并可在所述处理器上运行的计算机程序，所述处理器执行所述计算机程序时实现上述的热敏灸机器人位姿确定方法。
[0014]与现有技术相比，本专利技术的有益效果是：（1）利用多重激光测量数据最佳拟合得到表征目标穴位的最佳平面方程，据此计算出的操作头姿态角和目标距离更加准确，以便于后续的位姿确定；（2）将多重激光传感于艾条的四周的布置方式使得投射到目标穴位的激光光斑斑点距离更近，相互更紧凑，扩大了操作头实施灸疗的人体表面工作范围。
附图说明
[0015]图1为本专利技术第一实施例中热敏灸机器人位姿确定方法的流程图；图2为本专利技术第一实施例中激光传感器在热敏灸机器人上的安装位置示意图；图3为本专利技术第一实施例中激光传感器的位置俯视图；图4为图1中步骤S103的详细流程图；图5为本专利技术第二实施例中热敏灸机器人位姿确定系统的结构框图；图6为本专利技术第三实施例中计算机的结构框图。
[0016]如下具体实施方式将结合上述附图进一步说明本专利技术。
具体实施方式
[0017]为了便于理解本专利技术，下面将参照相关附图对本专利技术进行更全面的描述。附图中给出了本专利技术的若干实施例。但是，本专利技术可以以许多不同的形式来实现，并不限于本文所描述的实施例。相反地，提供这些实施例的目的是使对本专利技术的公开内容更加透彻全面。
[0018]需要说明的是，当元件被称为“固设于”另一个元件，它可以直接在另一个元件上或者也可以存在居中的元件。当一个元件被认为是“连接”另一个元件，它可以是直接连接到另一个元件或者可能同时存在居中元件。本文所使用的术语“垂直的”、“水平的”、“左”、“右”以及类似的表述只是为了说明的目的。
[0019]除非另有定义，本文所使用的所有的技术和科学术语与属于本专利技术的
的技术人员通常理解的含义相同。本文中在本专利技术的说明书中所使用的术语只是为了描述具体的实施例的目的，不是旨在于限制本专利技术。本文所使用的术语“及／或”包括一个或多个相关的所列项目的任意的和所有的组合。
[0020]实施例一请参阅图1，所示为本专利技术第一实施例中的热敏灸机器人位姿确定方法，在所述热敏灸机器人的操作头上安装有多个激光传感器，所述方法具体包括步骤S101至S104：S101，以预设的采样频率分别采集各所述激光传感器与人体体表目标穴位的第一距离数据；其中，如图2至图3所示，在热敏灸机器人的操作头上艾条的四周安装有3个激光传感器（在其他实施例中，该激光传感器的数量N≥3，其具体数量由用户自行设定），每个激光传感器与操作头或艾条的位置相对设置，各个激光传感器所发出的激光光点均聚焦于艾条头部的下方一点（该点位于艾条的中心轴线上）；进一步的，按照指定的采样频率f（该采样频率f由系统自动生成或用户自行设定），每一激光传感分别测量其距人体表面目标穴位的距离，以获取第一距离数据。
[0021]S102，基于所述操作头本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种热敏灸机器人位姿确定方法，在所述热敏灸机器人的操作头上安装有多个激光传感器，其特征在于，包括：以预设的采样频率分别采集各所述激光传感器与人体体表目标穴位的第一距离数据；基于所述操作头定义随体坐标系，并根据所述随体坐标系和所述第一距离数据获取各所述激光传感器的激光光点的坐标值以及所述操作头上艾条的坐标值；根据各所述激光光点的坐标值计算出各所述激光光点所形成的最佳平面的单位法向量，定义所述操作头的单位向量，并利用所述最佳平面的单位法向量和所述操作头的单位向量计算出所述操作头相对于所述最佳平面的姿态角；根据所述艾条的坐标值计算出所述艾条距离所述最佳平面的第二距离数据，并根据所述第二距离数据和所述姿态角确定所述热敏灸机器人的位姿。2.根据权利要求1所述的热敏灸机器人位姿确定方法，其特征在于，各所述激光传感器的激光光点聚焦于所述艾条的中心轴线上、且所述激光传感器的数量N≥3。3.根据权利要求1所述的热敏灸机器人位姿确定方法，其特征在于，根据各所述激光光点的坐标值计算出各所述激光光点所形成的最佳平面的单位法向量的步骤包括：利用最小二乘法对各所述激光光点的坐标值进行拟合，以得到各所述激光光点所形成的最佳平面的平面方程；利用所述最佳平面的平面方程按照第一公式计算出其对应的单位法向量。4.根据权利要求3所述的热敏灸机器人位姿确定方法，其特征在于，所述最佳平面的平面方程的表达式为：AX+BY+ CZ+D=0；所述最佳平面的单位法向量的计算公式为：；式中，n表示最佳平面的单位法向量。5.根据权利要求1所述的热敏灸机器人位姿确定方法，其特征在于，所述第二距离数据的计算公式为：；式中，...

【专利技术属性】
技术研发人员：肖丽丽，高付海，朴江民，杨孔雳，王明政，高岳，
申请(专利权)人：江西原科中医药智能装备有限公司，
类型：发明
国别省市：