具有振动头的机器人的控制方法、控制装置及理疗机器人制造方法及图纸

本发明专利技术涉及机器人技术领域，具体而言，涉及一种具有振动头的机器人的控制方法、控制装置及理疗机器人。具有振动头的机器人的控制方法包括：获取振动头受到的压力；过滤获取到的压力数据中频率较高的扰动；根据设定按压力和过滤后的压力数据，调节振动头的位置。本发明专利技术提供的具有振动头的机器人的控制方法、控制装置及理疗机器人，压力数据震荡明显减低，可获取更加精准的调节参数，在该调节参数的控制下，可将振动头调节至更加精准的位置，从而，振动头可实时贴于人体，并且末端可根据身体的起伏进行适应性移动，如此，振动头作用于人体的按压力均匀性更佳且更精确，可提高理疗机器人的理疗效果，并可降低危险性。并可降低危险性。并可降低危险性。

【技术实现步骤摘要】
具有振动头的机器人的控制方法、控制装置及理疗机器人


[0001]本专利技术涉及机器人
，具体而言，涉及一种具有振动头的机器人的控制方法、控制装置及理疗机器人。

技术介绍

[0002]理疗机器人是一种对人体进行理疗的机器人，其在工作过程中会控制理疗工具贴压在人体表面对人体进行理疗。
[0003]目前，具有振动按压功能的理疗机器人在控制理疗工具振动，以刺激人体穴位时，存在频率较高的扰动，导致理疗工具作用在人体上的按压力均匀性和精确度均较低，进而，导致理疗效果降低，并导致危险性升高。

技术实现思路

[0004]本专利技术的目的在于提供一种具有振动头的机器人的控制方法、控制装置及理疗机器人，以缓解现有技术中具有振动按压功能的理疗机器人存在的理疗效果低、危险性高的技术问题。
[0005]本专利技术提供的具有振动头的机器人的控制方法，包括：
[0006]获取所述振动头受到的压力；
[0007]过滤获取到的压力数据中频率较高的扰动；
[0008]根据设定按压力和过滤后的压力数据，调节所述振动头的位置。
[0009]优选地，作为一种可实施方式，所述根据设定按压力和过滤后的压力数据，调节所述振动头的位置，包括：
[0010]根据设定按压力和过滤后的压力数据，计算得到所述振动头的偏差位移；
[0011]根据所述振动头的偏差位移，调节所述振动头的位置。
[0012]优选地，作为一种可实施方式，所述根据所述振动头的偏差位移，调节所述振动头的位置，包括：
[0013]根据所述振动头的偏差位移，利用比例、积分、微分计算得到控制量；
[0014]根据所述控制量控制机械臂动作，以调节所述振动头的位置。
[0015]优选地，作为一种可实施方式，所述根据设定按压力和过滤后的压力数据，计算得到所述振动头的偏差位移，包括：
[0016]计算设定按压力与过滤后的压力数据的差值；
[0017]根据所述差值和牛顿第二定律，计算得到所述振动头的偏差加速度；
[0018]对所述振动头的偏差加速度进行积分，得到所述振动头的偏差速度；
[0019]对所述振动头的偏差速度进行积分，得到所述振动头的偏差位移。
[0020]本专利技术提供的具有振动头的机器人的控制装置，包括：
[0021]压力获取模块，用于获取所述振动头受到的压力；
[0022]低通滤波模块，用于过滤所述压力获取模块获取到的压力数据中频率较高的扰
动；
[0023]位置调节模块，用于根据经所述低通滤波器过滤后的压力数据和设定按压力，调节所述振动头的位置。
[0024]优选地，作为一种可实施方式，所述位置调节模块包括：
[0025]位移计算单元，用于根据过滤后的压力数据，计算得到所述振动头的偏差位移；
[0026]位置调节单元，用于根据所述振动头的偏差位移，调节所述振动头的位置。
[0027]优选地，作为一种可实施方式，所述位置调节单元包括比例
‑
积分
‑
微分控制器，所述比例
‑
积分
‑
微分控制器用于根据所述振动头的偏差位移，利用比例、积分、微分计算得到控制量，并根据所述控制量控制机械臂动作，以调节所述振动头的位置。
[0028]优选地，作为一种可实施方式，所述位移计算单元包括：
[0029]误差计算器，用于计算设定按压力与所述过滤后的压力数据的差值；
[0030]加速度计算器，用于根据所述差值与牛顿第二定律，计算得到所述振动头的偏差加速度；
[0031]第一积分器，用于对所述振动头的偏差加速度进行积分，得到所述振动头的偏差速度；
[0032]第二积分器，用于对所述振动头的偏差速度进行积分，得到所述振动头的偏差位移。
[0033]优选地，作为一种可实施方式，所述压力获取模块包括力传感器；
[0034]和/或，所述低通滤波模块包括低通滤波器。
[0035]本专利技术提供的理疗机器人，包括理疗工具和上述具有振动头的机器人的控制装置，所述理疗工具包括所述振动头。
[0036]与现有技术相比，本专利技术的有益效果在于：
[0037]振动头在工作过程中产生的振动，会导致压力数据中存在频率较高的扰动，导致数据震荡较严重，过滤掉压力数据中频率较高的扰动后，数据震荡能够明显减低。因过滤后的压力数据相对于未过滤的压力数据而言，震荡明显减低，故将设定按压力与过滤后的压力数据进行比较，并进行计算分析，可获取更加精准的调节参数，在该调节参数的控制下，可将振动头调节至更加精准的位置，从而，振动头可实时贴于人体，并且末端可根据身体的起伏进行适应性移动，如此，振动头作用于人体的按压力均匀性更佳且更精确，可提高理疗机器人的理疗效果，并可降低危险性。
附图说明
[0038]为了更清楚地说明本专利技术实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本专利技术的实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据提供的附图获得其他的附图。
[0039]图1为本专利技术实施例提供的具有振动头的机器人的控制方法的第一示意性流程图；
[0040]图2为本专利技术实施例提供的具有振动头的机器人在运行时的力传感器数据频谱图；
[0041]图3为本专利技术实施例提供的具有振动头的机器人在运行时振动头受到的Z向力在滤波前后的对比图；
[0042]图4为本专利技术实施例提供的具有振动头的机器人的控制方法的第二示意性流程图；
[0043]图5为本专利技术实施例提供的具有振动头的机器人的控制装置的结构示意图；
[0044]图6为本专利技术实施例提供的理疗机器人的控制流程图。
[0045]附图标记说明：
[0046]301
‑
压力获取模块；302
‑
低通滤波模块；303
‑
位置调节模块。
具体实施方式
[0047]下面将结合附图对本专利技术的技术方案进行清楚、完整地描述，显然，所描述的实施例是本专利技术一部分实施例，而不是全部的实施例。基于本专利技术中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本专利技术保护的范围。
[0048]下面通过具体的实施例子并结合附图对本专利技术做进一步的详细描述。
[0049]图1为本专利技术的一个实施例中一种具有振动头的机器人的控制方法的示意性流程图，图1的方法可以应用于理疗机器人或其他具有振动头的机器人，上述方法包括：
[0050]S102，获取振动头受到的压力。
[0051]具体地，在振动头工作过程中，可利用力传感器实时感测振动头受到的压力。
[0052]S104，过滤获取到的压力数据中频率较高的扰动。
[0053]振动头在工作过程中产生的振动，会本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种具有振动头的机器人的控制方法，其特征在于，包括：获取所述振动头受到的压力；过滤获取到的压力数据中频率较高的扰动；根据设定按压力和过滤后的压力数据，调节所述振动头的位置。2.根据权利要求1所述的具有振动头的机器人的控制方法，其特征在于，所述根据设定按压力和过滤后的压力数据，调节所述振动头的位置，包括：根据设定按压力和过滤后的压力数据，计算得到所述振动头的偏差位移；根据所述振动头的偏差位移，调节所述振动头的位置。3.根据权利要求2所述的具有振动头的机器人的控制方法，其特征在于，所述根据所述振动头的偏差位移，调节所述振动头的位置，包括：根据所述振动头的偏差位移，利用比例、积分、微分计算得到控制量；根据所述控制量控制机械臂动作，以调节所述振动头的位置。4.根据权利要求2或3所述的具有振动头的机器人的控制方法，其特征在于，所述根据设定按压力和过滤后的压力数据，计算得到所述振动头的偏差位移，包括：计算设定按压力与过滤后的压力数据的差值；根据所述差值和牛顿第二定律，计算得到所述振动头的偏差加速度；对所述振动头的偏差加速度进行积分，得到所述振动头的偏差速度；对所述振动头的偏差速度进行积分，得到所述振动头的偏差位移。5.一种具有振动头的机器人的控制装置，其特征在于，包括：压力获取模块，用于获取所述振动头受到的压力；低通滤波模块，用于过滤所述压力获取模块获取到的压力数据中频率较高的扰动；位置调节模块，用于根据经所述低通滤波器过滤后的压力数据和设定按压力，调节所述振动头的位置。6.根据权利要求5所述的...

【专利技术属性】
技术研发人员：陈兆芃，黎田，别东洋，白宇珅，
申请(专利权)人：北京思灵机器人科技有限责任公司，
类型：发明
国别省市：