CN113797088B - 机械臂和床的联动控制方法及控制系统 - Google Patents

机械臂和床的联动控制方法及控制系统 Download PDF

Info

Publication number
CN113797088B
CN113797088B CN202111014993.4A CN202111014993A CN113797088B CN 113797088 B CN113797088 B CN 113797088B CN 202111014993 A CN202111014993 A CN 202111014993A CN 113797088 B CN113797088 B CN 113797088B
Authority
CN
China
Prior art keywords
mechanical arm
meridian
return
preset
stroke
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
CN202111014993.4A
Other languages
English (en)
Other versions
CN113797088A (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.)
Zhongke Shangyi Health Technology Beijing Co ltd
Original Assignee
Zhongke Shangyi Health Technology Beijing 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 Zhongke Shangyi Health Technology Beijing Co ltd filed Critical Zhongke Shangyi Health Technology Beijing Co ltd
Priority to CN202111014993.4A priority Critical patent/CN113797088B/zh
Publication of CN113797088A publication Critical patent/CN113797088A/zh
Application granted granted Critical
Publication of CN113797088B publication Critical patent/CN113797088B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
    • A61H39/00—Devices for locating or stimulating specific reflex points of the body for physical therapy, e.g. acupuncture
    • A61H39/04—Devices for pressing such points, e.g. Shiatsu or Acupressure
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J11/00—Manipulators not otherwise provided for
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1661—Programme controls characterised by programming, planning systems for manipulators characterised by task planning, object-oriented languages
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1679—Programme controls characterised by the tasks executed
    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
    • A61H2201/00—Characteristics of apparatus not provided for in the preceding codes
    • A61H2201/16—Physical interface with patient
    • A61H2201/1657—Movement of interface, i.e. force application means
    • A61H2201/1659—Free spatial automatic movement of interface within a working area, e.g. Robot
    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
    • A61H2201/00—Characteristics of apparatus not provided for in the preceding codes
    • A61H2201/50—Control means thereof
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Robotics (AREA)
  • Health & Medical Sciences (AREA)
  • Rehabilitation Therapy (AREA)
  • Animal Behavior & Ethology (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • General Health & Medical Sciences (AREA)
  • Public Health (AREA)
  • Veterinary Medicine (AREA)
  • Physical Education & Sports Medicine (AREA)
  • Pain & Pain Management (AREA)
  • Epidemiology (AREA)
  • Invalid Beds And Related Equipment (AREA)

Abstract

本申请涉及一种机械臂和床的联动控制方法、控制系统以及智能人体经络调理设备通过获取经络行走路线；预设行程阈值，基于所述预设行程阈值控制所述机械臂按照所述经络行走路线执行行走指令；判断所述机械臂的行程是否到达所述预设行程阈值，是则发出指令信号并根据所述指令信号生成联动控制指令；根据所述联动控制指令控制床和机械臂联动动作。本申请能够通过判断所述机械臂的行程是否到达所述预设行程阈值实现机械臂和理疗床之间的联动控制，使得机械臂可以在机械臂范围短、行程够不着整个人体的情况下，通过机械臂和床联动，可以在不增加设备本身结构的情况下实现人体全覆盖调理，床和机械臂联动，保证同步，不会走偏。

Description

机械臂和床的联动控制方法及控制系统
技术领域
本公开涉及智能器械应用技术领域，尤其涉及一种机械臂和床的联动控制方法、控制系统以及智能人体经络调理设备。
背景技术
智能人体经络调理设备是依据中医经络疏通、调节原理，通过前沿人工智能技术、机器人技术、再结合精密伺服控制技术和多物理场能量刺激技术，集成实现的可代替人工手法的智能化设备。在使用智能人体经络调理设备进行调理时，是用机械臂带动调理设备对人体的经络部位进行治疗。
现有技术中，中医调理系统中，调理设备所在的机械臂在人体身上行走时，机械臂具有行程限制，这就导致机械臂的臂展范围不是足够长；而理疗时，为患者理疗用的床是固定的，理疗时床是不需要动的。因此，在调理过程中，机械臂调理不到患者身体的头部和脚部位置，因为已经超出了机械臂的最大施展范围。若是增加设备尺寸或者结构，回增加成本等，占据空间。
此外，在经络调理时，人体背部是分布面积最大的经络区域，现有技术中大多中医调理系统的机械臂的行程范围短，仅仅作用在此区域，其行程范围更不能完成患者身体的头部和脚部位置的调理。
发明内容
有鉴于此，本公开提出了一种机械臂和床的联动控制方法、控制系统以及智能人体经络调理设备，通过控制程序实现机械臂和理疗床之间的联动控制，使得机械臂可以在机械臂范围短、行程够不着整个人体的情况下，将整个人体调理完成；通过机械臂和床联动，可以在不增加设备本身结构的情况下实现人体全覆盖调理。
根据本公开的另一方面，提供了一种机械臂和床的联动控制方法，包括如下步骤：
S1、获取经络行走路线；
S2、预设行程阈值，基于所述预设行程阈值控制所述机械臂按照所述经络行走路线执行行走指令；
S3、判断所述机械臂的行程是否到达所述预设行程阈值，是则发出指令信号并根据所述指令信号生成联动控制指令；根据所述联动控制指令控制床和机械臂联动动作。
在一种可能的实现方式中，
在步骤S1中，所述获取经络行走路线，包括：
获取人体体表点云数据；
根据所述人体体表点云数据，建立经络行走轨迹；
识别并标记所述经络行走轨迹中的轨迹关键点，建立经络点画像列表。
在一种可能的实现方式中，
在步骤S2中，所述基于所述预设行程阈值控制所述机械臂按照所述经络行走路线执行行走指令，包括：
遍历所述经络点画像列表；
将所述经络点画像列表中的轨迹关键点发送至所述机械臂；
接收所述轨迹关键点，并基于所述预设行程阈值控制所述机械臂按照所述经络行走轨迹执行行走指令。
在一种可能的实现方式中，
在所述识别并标记所述经络行走轨迹中的轨迹关键点之后，还包括：
接收所述轨迹关键点；
基于插补算法，对所述轨迹关键点进行插补处理，获取插补处理后的轨迹关键点；
根据所述插补处理后的轨迹关键点建立经络点画像列表。
在一种可能的实现方式中，
还包括：
S4、预设回程阈值；
S5、基于所述回程阈值，预设机械臂回程路线和床回程路线；
S6、接收所述联动控制指令，根据所述联动控制指令控制所述机械臂按照所述机械臂回程路线、控制床按照所述床回程路线实现联动动作。
在一种可能的实现方式中，
还包括：
预设回程指令；
判断所述机械臂的行程是否到达所述预设回程阈值；若是
判断所述机械臂的行程到达所述预设回程阈值；则
控制所述机械臂按照所述经络行走修改路线，执行预设回程指令。
在一种可能的实现方式中，
在步骤S5中，所述预设机械臂回程路线，包括：
获取人体体表点云数据，建立经络行走轨迹；
识别并标记所述经络行走轨迹中的轨迹关键点；
基于所述回程阈值，对所述轨迹关键点的坐标值进行回程统一处理，获取坐标值经处理后的轨迹关键点；
根据所述坐标值经处理后的轨迹关键点，规划并获得所述预设机械臂回程路线。
在一种可能的实现方式中，
步骤S3中，在判断所述机械臂的行程是否到达所述预设行程阈值时，
若是判断所述机械臂的行程未到达所述预设行程阈值；则
控制所述机械臂继续按照所述经络行走路线数据执行行走指令。
根据本公开的一方面，提供了一种控制系统，包括：
处理器；
用于存储处理器可执行指令的存储器；
其中，所述处理器被配置为执行所述可执行指令时实现所述的机械臂和床的联动控制方法。
根据本公开的另一方面，提供了一种智能人体经络调理设备，包括机械臂和所述的控制系统，所述控制终端与所述机械臂的控制器电性连接。
技术效果：
本申请通过获取经络行走路线并发送至机械臂；预设行程阈值，基于所述预设行程阈值控制所述机械臂按照所述经络行走路线执行行走指令；判断所述机械臂的行程是否到达所述预设行程阈值，是则执行联动指令。能够通过控制程序实现机械臂和理疗床之间的联动控制，使得机械臂可以在机械臂范围短、行程够不着整个人体的情况下，将整个人体调理完成；通过机械臂和床联动，可以在不增加设备本身结构的情况下实现人体全覆盖调理。通过这种方法，可以使得小机械臂也能达到治疗整个人体的效果，并且准确的在人体身上进行行走，床和机械臂联动，保证同步，不会走偏。
根据下面参考附图对示例性实施例的详细说明，本公开的其它特征及方面将变得清楚。
附图说明
包含在说明书中并且构成说明书的一部分的附图与说明书一起示出了本公开的示例性实施例、特征和方面，并且用于解释本公开的原理。
图1示出为本发明机械臂和床的联动控制方法的实施流程示意图；
图2示出为本发明实施例2中的机械臂和床的联动控制方法的实施流程示意图；
图3示出为本发明控制系统的组成系统图；
图4示出为本发明智能人体经络调理设备的结构示意图；
附图标记列表：1、机械臂，2、AI视觉系统，3、振动调理头，4、浮动调理床；
具体实施方式
以下将参考附图详细说明本公开的各种示例性实施例、特征和方面。附图中相同的附图标记表示功能相同或相似的元件。尽管在附图中示出了实施例的各种方面，但是除非特别指出，不必按比例绘制附图。
在这里专用的词“示例性”意为“用作例子、实施例或说明性”。这里作为“示例性”所说明的任何实施例不必解释为优于或好于其它实施例。
另外，为了更好的说明本公开，在下文的具体实施方式中给出了众多的具体细节。本领域技术人员应当理解，没有某些具体细节，本公开同样可以实施。在一些实例中，对于本领域技术人员熟知的方法、手段、元件和电路未作详细描述，以便于凸显本公开的主旨。
实施例1
如图1所示，根据本公开的另一方面，提供了一种机械臂和床的联动控制方法，包括如下步骤：
S1、获取经络行走路线并发送至机械臂；
经络行走路线由点云采集设备或者摄像机或者AI视觉系统识别，比如利用AI视觉系统可以对躺在床上的患者进行扫描识别而获得数据，系统进行数据处理后，可以建立点云数据，进行根据这些数据建立虚拟经络模型，经络模型上具有经络关键点，将这些经络关键点之间建立联系，就可以作为机械臂的运动点位，使得机械臂在系统控制下按照经络点进行运动，以此实现对患者身体的经络按摩调理；
本申请通过控制程序实现机械臂和理疗床之间的联动控制，使得机械臂可以在机械臂范围短、行程够不着整个人体的情况下，将整个人体调理完成；通过机械臂和床联动，可以在不增加设备本身结构的情况下实现人体全覆盖调理。
S2、预设行程阈值，基于所述预设行程阈值控制所述机械臂按照所述经络行走路线执行行走指令；
机械臂按照所述经络行走路线执行行走指令即可，所述行走指令为系统根据经络路线自动设定的既定路线。为了避免“机械臂范围短、行程够不着整个人体”的发生，本处设置一个阈值，当机械臂行走至阈值时，床将会和机械臂同时往回移动统一的距离，保证下一步要走的几个点在机械臂范围内。
具体的：
根据床(实施例4所述的浮动调理床4)的尺寸以及浮动调理床4和机械臂之间的行程差，计算后由用户设定一个可以使得在机械臂和床联动回程后使得机械臂的工作范围覆盖人体全身的阈值；
在机械臂按照所述经络行走路线执行行走指令的同时，根据设定的阈值来监控机械臂的行程；
本实施例，也可以在机械臂和床上安装行程开关来限定机械臂的行程。
S3、判断所述机械臂的行程是否到达所述预设行程阈值，是则发出指令信号并根据所述指令信号生成联动控制指令；根据所述联动控制指令控制床和机械臂联动动作。
在机械臂按照所述经络行走路线执行行走指令时，若是机械臂的行程到达所述预设行程阈值，那么此时就触发联动指令，此时机械臂和床联动而回程一定距离，此距离由用户设定；
此外，联动指令需要在满足机械臂的行程到达所述预设行程阈值时，触发此指令的生效，对应的机械臂和床的动作，由用户提前在程序中设定；一旦机械臂的行程到达所述预设行程阈值，那么同时触发机械臂和床的回程指令，实现机械臂和床的联动动作。
上述经络行走路线的获取方式，由用户自行选择，也可以根据处理系统的数据端口而匹配对应的设备，在此不做限制。
需要说明的是，尽管以AI视觉系统作为示例介绍了采集经络数据如上，但本领域技术人员能够理解，本公开应不限于此。事实上，用户完全可根据个人喜好和/或实际应用场景灵活设定采集设备，只要可以获取体表点云数据即可。
基于本实施例的实施，本申请通过获取经络行走路线并发送至机械臂；预设行程阈值，基于所述预设行程阈值控制所述机械臂按照所述经络行走路线执行行走指令；判断所述机械臂的行程是否到达所述预设行程阈值，是则执行联动指令。能够通过控制程序实现机械臂和理疗床之间的联动控制，使得机械臂可以在机械臂范围短、行程够不着整个人体的情况下，将整个人体调理完成；通过机械臂和床联动，可以在不增加设备本身结构的情况下实现人体全覆盖调理。通过这种方法，可以使得小机械臂也能达到治疗整个人体的效果，并且准确的在人体身上进行行走，床和机械臂联动，保证同步，不会走偏。
在一种可能的实现方式中，
步骤S3中，在判断所述机械臂的行程是否到达所述预设行程阈值时，
若是判断所述机械臂的行程未到达所述预设行程阈值；则
控制所述机械臂继续按照所述经络行走路线数据执行行走指令。
在机械臂按照所述经络行走路线执行行走指令时，若是机械臂的行程到达所述预设行程阈值，那么此时就触发联动指令，此时机械臂和床联动而回程一定距离，此距离由用户设定；
在机械臂按照所述经络行走路线执行行走指令时，若是机械臂的行程没有到达所述预设行程阈值，那么此时继续按照所述经络行走路线执行行走指令；即机械臂继续按照原来的经络行走路线继续行走，不改变其既定理疗行走路线。
在一种可能的实现方式中，
在步骤S1中，所述获取经络行走路线，包括：
获取人体体表点云数据；
根据所述人体体表点云数据，建立经络行走轨迹；
识别并标记所述经络行走轨迹中的轨迹关键点，建立经络点画像列表。
人体体表点云数据可以通过摄像机和3D点云传感器进行扫描获取；在识别出人体体表点云数据后，根据所述人体体表点云数据建立行走轨迹；其中，行走轨迹包括人体重要的穴位点坐标信息等。
对经络行走轨迹中的轨迹关键点(关键部位点，可以是关键经络点或者关键部位)进行识别标记，建立由轨迹关键点组成的经络点画像列表，便于后续根据经络点画像列表来顺序执行轨迹。
在一种可能的实现方式中，
在步骤S2中，所述基于所述预设行程阈值控制所述机械臂按照所述经络行走路线执行行走指令，包括：
遍历所述经络点画像列表；
将所述经络点画像列表中的轨迹关键点发送至所述机械臂；
接收所述轨迹关键点，并基于所述预设行程阈值控制所述机械臂按照所述经络行走轨迹执行行走指令。
在获取经络点画像列表后，遍历所述经络点画像列表，即可获取经络点画像列表中的轨迹关键点，机械臂根据经络点画像列表中的轨迹关键点，按照所述经络行走轨迹执行行走指令；
此过程中，会设置一个阈值，使得机械臂在“阈值”监控下而行走；当机械臂行走至阈值时，床将会和机械臂同时往回移动统一的距离，保证下一步要走的几个点在机械臂范围内。
为了优化轨迹关键点，本处使用插补算法，对轨迹关键点进行密集化，可以使轨迹行走更平滑。
在一种可能的实现方式中，
在所述识别并标记所述经络行走轨迹中的轨迹关键点之后，还包括：
接收所述轨迹关键点；
基于插补算法，对所述轨迹关键点进行插补处理，获取插补处理后的轨迹关键点；
根据所述插补处理后的轨迹关键点建立经络点画像列表。
基于插补算法，对所述轨迹关键点进行密集化处理。本实施例使用插补算法对轨迹关键点优化处理，对轨迹关键点进行密集化，可以使轨迹行走更平滑。
实施例2
在实施例1的基础上，为了避免机械臂到达预设行程阈值后，与床进行联动返回一段距离后，超出工作范围和人体的全身长度等，本实施例设定了回程的阈值，来确保机械臂和床的联动在一个适当的距离，此距离可以由用户设定即可。
如附图2所示，在一种可能的实现方式中，
还包括：
S4、预设回程阈值；
同理，回程阈值由用户根据机械臂臂长自行设定即可；
S5、基于所述回程阈值，预设机械臂回程路线和床回程路线；
当接收所述联动控制指令信号，控制机械臂和床同步联动动作时：
床将会和机械臂同时往回移动一定距离，具体距离根据机械臂的臂长来由用户设定即可；具体的：
机械臂和床联动回程时，需要提前设置机械臂的回程路线，即设定机械臂的回程指令，在触发行程阈值、接收到所述联动控制指令信号时，控制所述机械臂按照所述机械臂回程路线动作，实现回程；
具体处理时，根据预设的回程阈值统一改变经络行走路线的数据，根据回程阈值来修改经络行走路线各个轨迹关键点的距离，保证下一步要走的点在机械臂范围内。
其中，各个轨迹关键点的距离不限于在一个方向上，比如一个轨迹点在X方向上的坐标值，需要根据回程阈值来加减处理，以便获得一个基于回程阈值修改后的轨迹点的坐标值，以此修改后坐标值作为机械臂的下一个运动点位坐标值。
本技术还要同时根据回程阈值设定床的同步联动指令，即提前预设好床回程路线，使得在触发行程阈值、接收到所述联动控制指令信号时，根据发出的联动控制指令而控制床根据床回程指令而和所述机械臂同步联动。
机械臂回程时，床和机械臂联动，机械臂回程距离和床的回程距离同步，因此基于回程阈值，提前设定床的回程指令即可，床的回程距离和机械臂的回程距离是一样的，沿同一个X方向移动相同距离即可，比如10cm；
S6、接收所述联动控制指令，并根据所述联动控制指令控制所述机械臂按照所述机械臂回程路线、控制床按照所述床回程路线实现联动动作。
在接收联动控制指令信号后，此时同时触发机械臂和床的回程联动指令，即根据提前预设的机械臂回程路线和床回程路线，分别控制床和机械臂按照各自对应的指令执行即可，实现床和机械臂在同一个方向联动回程。
机械臂往回走的同时，床同步跟随机械臂移动同样距离。
在一种可能的实现方式中，
还包括：
预设回程指令；
判断所述机械臂的行程是否到达所述预设回程阈值；若是
判断所述机械臂的行程到达所述预设回程阈值；则
控制所述机械臂按照所述经络行走修改路线，执行预设回程指令。
回程指令由用户提前输入，在机械臂的行程到达所述预设回程阈值时，触发回程指令，控制所述机械臂按照所述经络行走修改路线，执行预设回程指令；
回程后，可以是机械臂和床复位，也可以是回到初始位置，还可以是做到停止位置，由用户设定即可。
在一种可能的实现方式中，
在步骤S5中，所述预设机械臂回程路线，包括：
获取人体体表点云数据，建立经络行走轨迹；
识别并标记所述经络行走轨迹中的轨迹关键点；
基于所述回程阈值，对所述轨迹关键点的坐标值进行回程统一处理，获取坐标值经处理后的轨迹关键点；
根据所述坐标值经处理后的轨迹关键点，规划并获得所述预设机械臂回程路线。
人体体表点云数据可以通过摄像机和3D点云传感器进行扫描获取；在识别出人体体表点云数据后，根据所述人体体表点云数据建立行走轨迹；其中，行走轨迹包括人体重要的穴位点坐标信息等。
对经络行走轨迹中的轨迹关键点(关键部位点，可以是关键经络点或者关键部位)进行识别标记，建立由轨迹关键点组成的经络点画像列表，便于后续根据经络点画像列表来顺序执行轨迹；
机械臂回程路线提前设定；
在回程时，需要对穴位点的坐标整体修改统一，即进行坐标值回程统一处理，获得坐标值坐标值经处理后的轨迹关键点；由这些坐标值经处理后的轨迹关键点规划行走轨迹并得到经络行走修改后的路线数据，通过此数据经过系统计算处理而获得机械臂回程路线。
回程时，机械臂按照机械臂回程路线行走。
实施例3
根据本公开的一方面，提供了一种控制系统，包括：
处理器；
用于存储处理器可执行指令的存储器；
其中，所述处理器被配置为执行所述可执行指令时实现所述的机械臂和床的联动控制方法。
参阅图3，本公开实施例控制系统包括处理器以及用于存储处理器可执行指令的存储器。其中，处理器被配置为执行可执行指令时实现前面任一所述的机械臂和床的联动控制方法。
此处，应当指出的是，处理器的个数可以为一个或多个。同时，在本公开实施例的控制系统中，还可以包括输入装置和输出装置。其中，处理器、存储器、输入装置和输出装置之间可以通过总线连接，也可以通过其他方式连接，此处不进行具体限定。
存储器作为存储介质，可用于存储软件程序、计算机可执行程序和各种模块，如：本公开实施例的机械臂和床的联动控制方法所对应的程序或模块。处理器通过运行存储在存储器中的软件程序或模块，从而执行**设备的各种功能应用及数据处理。
输入装置可用于接收输入的数字或信号。其中，信号可以为产生与设备/终端/服务器的用户设置以及功能控制有关的键信号。输出装置可以包括显示屏等显示设备。
实施例4
根据本公开的另一方面，提供了一种智能人体经络调理设备，包括机械臂和所述的控制系统，所述控制终端与所述机械臂的控制器电性连接。
如图4所示，本实施例提供的智能人体经络调理设备，包括机械臂1和所述的控制终端，机械臂1和控制终端按照实施例1-3所述的方案进行控制、执行。
本实施例的智能人体经络调理设备，除了一对机械臂1，还包括AI视觉系统2、振动调理头3和浮动调理床4组成，AI视觉系统2用于识别经络、振动调理头3用于振动击打经络穴位点等，浮动调理床4用于患者躺下，可以调节空间位置。
其中，机械臂1具备控制器，可以与控制系统进行通讯；
浮动调理床4具有伺服系统等，可以接受控制系统的指令而动作；具体不做描述。
使用过程如下：
患者做中医设备调理时，仰卧或俯卧在浮动调理床4上；
由四个摄像头组成的AI视觉系统2快速识别出人体正面或背面的经络路径，并经过插值规划后传递给机械臂1，本技术的机械臂1为双臂机器人；
再由双臂机器人携带振动调理头3循经精准运行；
达到疏通经络、激活人体机能、调控人体之功能。
以上已经描述了本公开的各实施例，上述说明是示例性的，并非穷尽性的，并且也不限于所披露的各实施例。在不偏离所说明的各实施例的范围和精神的情况下，对于本技术领域的普通技术人员来说许多修改和变更都是显而易见的。本文中所用术语的选择，旨在最好地解释各实施例的原理、实际应用或对市场中的技术的技术改进，或者使本技术领域的其它普通技术人员能理解本文披露的各实施例。

Claims (8)

1.一种机械臂和床的联动控制方法，其特征在于，包括如下步骤：
S1、获取经络行走路线；
S2、预设行程阈值，基于所述预设行程阈值控制所述机械臂按照所述经络行走路线执行行走指令；
S3、判断所述机械臂的行程是否到达所述预设行程阈值，是则发出指令信号并根据所述指令信号生成联动控制指令；根据所述联动控制指令控制床和机械臂联动动作；
S4、预设回程阈值；
S5、基于所述回程阈值，预设机械臂回程路线和床回程路线；
S6、接收所述联动控制指令，根据所述联动控制指令控制所述机械臂按照所述机械臂回程路线、控制床按照所述床回程路线实现联动动作；
还包括：
预设回程指令；
判断所述机械臂的行程是否到达所述预设回程阈值；若是
判断所述机械臂的行程到达所述预设回程阈值；则
控制所述机械臂按照所述经络行走修改路线，执行预设回程指令。
2.根据权利要求1所述的一种机械臂和床的联动控制方法，其特征在于，在步骤S1中，所述获取经络行走路线，包括：
获取人体体表点云数据；
根据所述人体体表点云数据，建立经络行走轨迹；
识别并标记所述经络行走轨迹中的轨迹关键点，建立经络点画像列表。
3.根据权利要求2所述的一种机械臂和床的联动控制方法，其特征在于，在步骤S2中，所述基于所述预设行程阈值控制所述机械臂按照所述经络行走路线执行行走指令，包括：
遍历所述经络点画像列表；
将所述经络点画像列表中的轨迹关键点发送至所述机械臂；
接收所述轨迹关键点，并基于所述预设行程阈值控制所述机械臂按照所述经络行走轨迹执行行走指令。
4.根据权利要求2所述的一种机械臂和床的联动控制方法，其特征在于，在所述识别并标记所述经络行走轨迹中的轨迹关键点之后，还包括：
接收所述轨迹关键点；
基于插补算法，对所述轨迹关键点进行插补处理，获取插补处理后的轨迹关键点；
根据所述插补处理后的轨迹关键点建立经络点画像列表。
5.根据权利要求1所述的一种机械臂和床的联动控制方法，其特征在于，在步骤S5中，所述预设机械臂回程路线，包括：
获取人体体表点云数据，建立经络行走轨迹；
识别并标记所述经络行走轨迹中的轨迹关键点；
基于所述回程阈值，对所述轨迹关键点的坐标值进行回程统一处理，获取坐标值经处理后的轨迹关键点；
根据所述坐标值经处理后的轨迹关键点，规划并获得预设机械臂回程路线。
6.根据权利要求1所述的一种机械臂和床的联动控制方法，其特征在于，步骤S3中，在判断所述机械臂的行程是否到达所述预设行程阈值时，
若是判断所述机械臂的行程未到达所述预设行程阈值；则
控制所述机械臂继续按照所述经络行走路线数据执行行走指令。
7.一种控制系统，其特征在于，包括：
处理器；
用于存储处理器可执行指令的存储器；
其中，所述处理器被配置为执行所述可执行指令时实现权利要求1至6中任意一项所述的机械臂和床的联动控制方法。
8.一种智能人体经络调理设备，其特征在于，包括机械臂和权利要求7所述的控制系统，所述控制终端与所述机械臂的控制器电性连接。
CN202111014993.4A 2021-08-31 2021-08-31 机械臂和床的联动控制方法及控制系统 Active CN113797088B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111014993.4A CN113797088B (zh) 2021-08-31 2021-08-31 机械臂和床的联动控制方法及控制系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111014993.4A CN113797088B (zh) 2021-08-31 2021-08-31 机械臂和床的联动控制方法及控制系统

Publications (2)

Publication Number Publication Date
CN113797088A CN113797088A (zh) 2021-12-17
CN113797088B true CN113797088B (zh) 2023-05-16

Family

ID=78894442

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111014993.4A Active CN113797088B (zh) 2021-08-31 2021-08-31 机械臂和床的联动控制方法及控制系统

Country Status (1)

Country Link
CN (1) CN113797088B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114074330B (zh) * 2022-01-19 2022-05-13 成都博恩思医学机器人有限公司 一种机器人控制方法、系统、机器人及存储介质

Family Cites Families (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE2415426A1 (de) * 1974-01-28 1975-10-02 Oskar A Mueller Geraet zur massage des menschlichen koerpers
TWM350346U (en) * 2008-07-02 2009-02-11 Cai-Fu Huang Pressing-type massage machine
CN201642444U (zh) * 2010-04-23 2010-11-24 陈志勇 固本能量机
CN101884584B (zh) * 2010-07-30 2012-07-18 山东建筑大学 一种中老年退行性腰腿痛中医按摩机器人
CN103932865B (zh) * 2014-04-21 2016-01-13 宋玉玲 一种数字控制拟人化按摩机
CN106038252A (zh) * 2016-05-18 2016-10-26 镇江高等职业技术学校 基于视觉定位的中医按摩机器人控制方法
CN106821718A (zh) * 2017-03-24 2017-06-13 徐加国 全智能扫描按摩舒经活络的保健方法及机器人
CN109674647A (zh) * 2019-03-07 2019-04-26 西安伊蔓蒂电子科技有限公司 一种按摩机器人
CN212547627U (zh) * 2020-04-16 2021-02-19 深圳瀚维智能医疗科技有限公司 理疗按摩机器人
CN112057326B (zh) * 2020-09-07 2021-08-06 中科尚易健康科技(北京)有限公司 一种用于经络调理系统的探针镜像装置及其算法
WO2022073467A1 (zh) * 2020-10-09 2022-04-14 谈斯聪 一种陪护按摩双臂多任务并行处理机器人装置

Also Published As

Publication number Publication date
CN113797088A (zh) 2021-12-17

Similar Documents

Publication Publication Date Title
EP2813194B1 (en) Control of limb device
CN109498384B (zh) 一种按摩部位识别、定位、按摩方法及装置、设备
CN108564643B (zh) 基于ue引擎的表演捕捉系统
CN113797088B (zh) 机械臂和床的联动控制方法及控制系统
JP2022534666A (ja) 画像処理方法、装置、電子機器及び記憶媒体
CN108466265B (zh) 机械手臂路径规划与作业方法、装置以及计算机设备
WO2019047415A1 (zh) 轨迹跟踪方法和装置、存储介质、处理器
WO2022227664A1 (zh) 机器人姿态的控制方法、机器人、存储介质及计算机程序
JP7417356B2 (ja) ロボット制御システム
CN112405504B (zh) 外骨骼机器人
JP4164737B2 (ja) 物体認識装置及び方法並びにロボット装置
CN115363762A (zh) 手术机器人的摆位方法、装置及计算机设备
CN115741732A (zh) 一种按摩机器人的交互式路径规划及运动控制方法
WO2023082949A1 (zh) 智能体的控制方法、装置、电子设备、程序及存储介质
CN113876556A (zh) 一种三维激光扫描按摩机器人系统
CN110811497A (zh) 一种胶囊内窥镜的控制方法及应用其的胶囊内窥镜
WO2020172782A1 (zh) 一种基于摄像头的经颅磁刺激诊疗检测系统
CN112904994A (zh) 手势识别方法、装置、计算机设备和存储介质
CN110363811A (zh) 用于抓取设备的控制方法、装置、存储介质及电子设备
CN113796963B (zh) 具备力感知反馈调节的机械臂控制方法和控制终端
WO2023078249A1 (zh) 一种手术机器人避障方法、系统、装置和存储介质
CN111752394A (zh) 非植入型可穿戴的双层电极舌触力反馈控制系统及装置
CN109531578B (zh) 仿人机械手臂体感控制方法及装置
CN113808163A (zh) 机械臂位置的动图动态展示方法和控制终端
CN113752257B (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