CN108524187A - 一种六自由度的上肢康复机器人控制系统 - Google Patents

一种六自由度的上肢康复机器人控制系统 Download PDF

Info

Publication number
CN108524187A
CN108524187A CN201810173731.4A CN201810173731A CN108524187A CN 108524187 A CN108524187 A CN 108524187A CN 201810173731 A CN201810173731 A CN 201810173731A CN 108524187 A CN108524187 A CN 108524187A
Authority
CN
China
Prior art keywords
module
control
control system
motion
control module
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.)
Granted
Application number
CN201810173731.4A
Other languages
English (en)
Other versions
CN108524187B (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.)
Anhui Hagong Peugeot medical and Health Industry Co.,Ltd.
Original Assignee
HRG International Institute for Research and Innovation
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 HRG International Institute for Research and Innovation filed Critical HRG International Institute for Research and Innovation
Priority to CN201810173731.4A priority Critical patent/CN108524187B/zh
Publication of CN108524187A publication Critical patent/CN108524187A/zh
Application granted granted Critical
Publication of CN108524187B publication Critical patent/CN108524187B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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
    • A61H1/00—Apparatus for passive exercising; Vibrating apparatus ; Chiropractic devices, e.g. body impacting devices, external devices for briefly extending or aligning unbroken bones
    • A61H1/02—Stretching or bending or torsioning apparatus for exercising
    • A61H1/0274—Stretching or bending or torsioning apparatus for exercising for the upper limbs
    • 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
    • A61H1/00—Apparatus for passive exercising; Vibrating apparatus ; Chiropractic devices, e.g. body impacting devices, external devices for briefly extending or aligning unbroken bones
    • A61H1/02—Stretching or bending or torsioning apparatus for exercising
    • A61H1/0214—Stretching or bending or torsioning apparatus for exercising by rotating cycling movement
    • 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
    • A61H1/00—Apparatus for passive exercising; Vibrating apparatus ; Chiropractic devices, e.g. body impacting devices, external devices for briefly extending or aligning unbroken bones
    • A61H1/02—Stretching or bending or torsioning apparatus for exercising
    • A61H1/0274—Stretching or bending or torsioning apparatus for exercising for the upper limbs
    • A61H1/0277—Elbow
    • 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
    • A61H1/00—Apparatus for passive exercising; Vibrating apparatus ; Chiropractic devices, e.g. body impacting devices, external devices for briefly extending or aligning unbroken bones
    • A61H1/02—Stretching or bending or torsioning apparatus for exercising
    • A61H1/0274—Stretching or bending or torsioning apparatus for exercising for the upper limbs
    • A61H1/0281—Shoulder
    • A—HUMAN NECESSITIES
    • A63—SPORTS; GAMES; AMUSEMENTS
    • A63B—APPARATUS FOR PHYSICAL TRAINING, GYMNASTICS, SWIMMING, CLIMBING, OR FENCING; BALL GAMES; TRAINING EQUIPMENT
    • A63B21/00—Exercising apparatus for developing or strengthening the muscles or joints of the body by working against a counterforce, with or without measuring devices
    • A63B21/00178—Exercising apparatus for developing or strengthening the muscles or joints of the body by working against a counterforce, with or without measuring devices for active exercising, the apparatus being also usable for passive exercising
    • A—HUMAN NECESSITIES
    • A63—SPORTS; GAMES; AMUSEMENTS
    • A63B—APPARATUS FOR PHYSICAL TRAINING, GYMNASTICS, SWIMMING, CLIMBING, OR FENCING; BALL GAMES; TRAINING EQUIPMENT
    • A63B21/00—Exercising apparatus for developing or strengthening the muscles or joints of the body by working against a counterforce, with or without measuring devices
    • A63B21/005—Exercising apparatus for developing or strengthening the muscles or joints of the body by working against a counterforce, with or without measuring devices using electromagnetic or electric force-resisters
    • A—HUMAN NECESSITIES
    • A63—SPORTS; GAMES; AMUSEMENTS
    • A63B—APPARATUS FOR PHYSICAL TRAINING, GYMNASTICS, SWIMMING, CLIMBING, OR FENCING; BALL GAMES; TRAINING EQUIPMENT
    • A63B23/00—Exercising apparatus specially adapted for particular parts of the body
    • A63B23/035—Exercising apparatus specially adapted for particular parts of the body for limbs, i.e. upper or lower limbs, e.g. simultaneously
    • A63B23/12—Exercising apparatus specially adapted for particular parts of the body for limbs, i.e. upper or lower limbs, e.g. simultaneously for upper limbs or related muscles, e.g. chest, upper back or shoulder muscles
    • 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/01—Constructive details
    • A61H2201/0107—Constructive details modular
    • 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/12—Driving means
    • A61H2201/1207—Driving means with electric or magnetic drive
    • 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/1602—Physical interface with patient kind of interface, e.g. head rest, knee support or lumbar support
    • A61H2201/1635—Hand or arm, e.g. handle
    • A61H2201/1638—Holding means therefor
    • 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
    • A61H2201/5007—Control means thereof computer controlled
    • 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
    • A61H2201/5058—Sensors or detectors
    • A61H2201/5061—Force sensors
    • 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
    • A61H2205/00—Devices for specific parts of the body
    • A61H2205/06—Arms
    • A—HUMAN NECESSITIES
    • A63—SPORTS; GAMES; AMUSEMENTS
    • A63B—APPARATUS FOR PHYSICAL TRAINING, GYMNASTICS, SWIMMING, CLIMBING, OR FENCING; BALL GAMES; TRAINING EQUIPMENT
    • A63B23/00—Exercising apparatus specially adapted for particular parts of the body
    • A63B2023/006—Exercising apparatus specially adapted for particular parts of the body for stretching exercises

Abstract

本发明公开了一种六自由度的上肢康复机器人控制系统，包括控制系统软件、工控机和与工控机连接的人机交互设备以及总线控制模块；所述控制系统软件搭载在工控机中运行；所述人机交互设备连接工控机，所述总线控制模块通过内部总线与一路PWM模块、模拟量模块和数字量模块连接，所述总线控制模块通过以太网线与5路伺服驱动器连接；所述5路伺服驱动器通过电缆分别与5路直流伺服电机相连，所述5路直流伺服电机上的绝对值编码器通过电缆连接5路伺服驱动器，所述1路PWM模块通过电缆连接到舵机，所述模拟量模块连接舵机末端的电位计，所述模拟量模块连接六维力传感器，所述数字量模块连接急停开关和限位开关。

Description

一种六自由度的上肢康复机器人控制系统
技术领域
本发明涉及机器人技术和康复医疗技术领域，更具体涉及一种六自由度的上肢康复机器人控制系统。
背景技术
脑卒中、中风和脊髓损伤等造成的运动神经损伤会导致上肢运动功能障碍，给患者的身心造成重大的影响。患者患病后能够在有效时间内接受正确的康复治疗，一定程度上可以辅助患者恢复上肢运动能力。
传统方式是康复治疗师一对一的进行康复治疗，需要大量康复治疗师的参与，并且康复时间长。在康复训练中使用康复机器人可以取代康复理疗师大部分的繁重工作，并且对康复数据的处理更准确，能从精确数据上将患者情况进行分类，治疗更加有针对性。
目前上肢康复机器人的研究仍处于发展阶段，采用的康复系统多是借鉴于工业控制中的关节型机械人系统，控制系统结构复杂，功能模块分布在不同的采集卡上，采集卡之间通过外部总线的方式进行数据传输，大大降低系统的执行效率，延长系统周期时间，伺服系统和控制器之间的通信方式不能提供关节处电机高同步性的要求；此外现有的康复系统多是机械式的带动患者手臂运动，操作模式单一，患者残余肢体力得不到有效利用，患者不能主动参与其中，不利于患者的积极参与和康复效果的准确反馈。
发明内容
本发明所要解决的技术问题在于如何简化控制系统结构，提高控制系统执行效率，提高设备关节同步性。
本发明是通过以下技术方案解决上述技术问题的：
一种六自由度的上肢康复机器人控制系统，所述控制系统为以太网总线型拓扑结构，包括控制系统软件、工控机和与工控机连接的人机交互设备以及总线控制模块；
所述控制系统软件搭载在工控机中运行；
所述人机交互设备连接工控机，用于显示并选择控制系统软件提供给用户的互动训练模式，所述控制系统软件根据用户选择的互动训练模式执行相应的轨迹运动程序；
所述总线控制模块通过内部总线与一路PWM模块、模拟量模块和数字量模块连接，所述总线控制模块通过以太网线与5路伺服驱动器连接；
所述5路伺服驱动器通过电缆分别与5路直流伺服电机相连，控制机械臂上的控制前臂旋前/旋后、肘关节屈/伸、肩关节水平内收/外展、肩关节屈/伸、肩关节内旋/外旋电机旋转；
所述5路直流伺服电机上的绝对值编码器通过电缆连接5路伺服驱动器，5路伺服驱动器通过总线控制模块与工控机连接，提供数据给工控机内软件进行数据处理；
所述1路PWM模块通过电缆连接到舵机，实现对机械臂上腕关节屈/伸控制；
所述模拟量模块连接舵机末端的电位计将实际电机位置值通过模拟量模块传输到总线控制模块；
所述模拟量模块连接六维力传感器，将机械臂末端的空间力和力矩传输到总线控制模块，所述总线控制模块将模拟量数据通过以太网总线传输到工控机，提供给工控机内软件进行数据处理；
所述数字量模块连接急停开关和限位开关，所述数字量模块将数字量数据采集到总线控制模块，总线控制模块将模拟量数据通过以太网总线传输到工控机，提供给工控机内软件进行数据处理。
进一步地，所述控制系统软件包括系统任务管理模块、运动控制模块、数据采集处理模块、逻辑处理模块、界面显示模块和总线处理模块；所述系统任务管理模块对运动控制模块、数据采集处理模块、逻辑处理模块、界面显示模块和总线处理模块进行任务分配，所述运动控制模块通过内置轨迹运动程序对5路直流伺服电机和舵机的运动进行控制，所述数据采集处理模块对采集到的5路直流伺服电机绝对值编码器数据和舵机电位计数据进行处理，所述逻辑处理模块对接收到的数字量模块数据进行逻辑处理，所述界面显示模块将软件控制系统中需要显示的数据处理并发送到人机交互设备，所述总线处理模块将运动控制模块中产生的控制指令发送给总线控制模块，并将从总线控制模块中接收到的数据发送给运动控制模块、数据采集处理模块、逻辑处理模块和界面显示模块。
进一步地，所述系统任务管理模块、运动控制模块、数据采集处理模块、逻辑处理模块、界面显示模块和总线处理模块集成在同一个控制系统软件中。
进一步地，所述运动控制模块中的内置轨迹运动程序为模拟正常生活环境中手臂的常规活动的游戏程序。
进一步地，所述内置轨迹运动程序包括平面轨迹运动程序、平面阻抗/助动轨迹运动程序、三维轨迹运动程序以及三维阻抗/助动轨迹运动程序。
进一步地，所述数据采集处理模块包括关节实际角度数据处理程序和六维力传感器数据处理程序，所述关节实际角度数据处理程序将采集到的编码器数据转换成关节的实际转动角度值，所述六维力传感器数据处理程序将采集到的六维力数据通过矩阵转换，转换成实际在X,Y,Z方向的力值和力矩值。
进一步地，所述人机交互设备包括鼠标键盘和液晶显示器，所述鼠标键盘用于在液晶显示器界面上进行操作，所述液晶显示器显示控制系统软件提供给用户的互动训练模式。
进一步地，所述控制系统软件提供给用户的互动训练模式包括主动控制模式、被动控制模式、助动控制模式和阻抗控制模式。
进一步地，所述主动控制模式对应的轨迹运动程序执行过程为：患者患肢带动机械臂运动，患者带动患肢运动过程中，带动5路直流伺服电机转动，绝对值编码器及电位计数据实时传输到数据采集处理模块中，数据采集处理模块将对应关节在关节坐标系下的实际角度转换成笛卡尔坐标系下的空间位置，该空间位置的变换对应人机交互界面上目标的位置移动，实现主动控制下互动的效果，控制系统同时记录下训练中的数据信息。
进一步地，所述被动控制模式对应的轨迹运动程序执行过程为：运动控制模块通过逆解将笛卡尔坐标系下的空间轨迹上点的位置转换成机械臂上对应关节的指令角度，同时5路直流伺服电机转动的实际角度值会通过绝对值编码器和电位计传输给软件控制系统中的运动控制模块，运动控制模块将绝对值编码器和电位计反馈的实际值与从轨迹运动程序中获得转换后的指令位置值进行比较，做位置值的补偿，最终运动控制模块通过总线将补偿后的关节角度值发送给5路伺服驱动器和1路PWM模块，控制5路直流伺服电机转动确定的角度，控制系统同时记录下训练中的数据信息。
进一步地，所述助动控制模式对应的轨迹运动程序执行过程为：根据轨迹运动程序中路径描述的笛卡尔坐标系下机械臂末端位置的空间轨迹，运动控制模块通过逆解将笛卡尔坐标系下的空间轨迹上点的位置转换成机械臂上对应关节的指令角度，同时5路直流伺服电机转动的实际角度值通过绝对值编码器和电位计传输给运动控制模块，运动控制模块将绝对值编码器和电位计反馈的实际值与从轨迹运动程序中获得转换后的指令位置值进行比较，做位置值的补偿，得到位置环的期望输入值，另外，六维力传感器将患者患肢末端施加在机械臂上空间方向的3个力Fx，Fy，Fz和3个方向的力矩Mx，MY，MZ数据反馈给运动控制模块，转换为轨迹控制程序中位置环、速度环和电流环控制方程应用参数，完成力矩模式下控制电机转动确定的角度，带动机械臂关节转动确定角度，控制系统同时记录下训练中的数据信息。
进一步地，所述阻抗控制模式对应的轨迹运动程序执行过程为：根据轨迹运动程序中路径描述的笛卡尔坐标系下机械臂末端位置的空间轨迹，运动控制模块通过逆解将笛卡尔坐标系下的空间轨迹上点的位置转换成机械臂上对应关节的指令角度，同时5路直流伺服电机转动的实际角度值会通过绝对值编码器和电位计传输给运动控制模块，运动控制模块将绝对编码器和电位计反馈的实际值与从轨迹运动程序中获得转换后的指令位置值进行比较，做位置值的补偿，得到位置环的期望输入值，另外，六维力传感器将患者患肢末端施加在机械臂上空间方向的3个力Fx，Fy，Fz和3个方向的力矩Mx，MY，MZ数据反馈给运动控制模块，转换为位置环、速度环和电流环控制方程应用参数，完成力矩模式下控制电机转动确定的角度，带动机械臂关节转动确定角度。
本发明相比现有技术具有以下优点：
(1)本发明提供的控制系统在康复训练机器人设备上采用总线型互联网拓扑结构及技术，设备执行端所有器件都直接通过总线连接，简化控制系统结构，简化接线，减少系统周期时间，提高设备关节同步性；
(2)本发明提供的控制系统将控制系统软件都集成在一个开发环境下，执行在同一个硬件平台，减少控制器硬件，实现大量的数据存储，有益于患者训练报告的归纳，可以运行大量规划好适合患者康复治疗的游戏应用，同时将多控制器之间的外部通信方式改换成软件程序的调用，简化系统结构，增加系统的稳定性；
(3)本发明提供的控制系统中采用六维力传感器作为患者患肢与设备之间的接口，通过运动学正向/逆向运算和阻抗运算实现患者可参与的多种训练模式转换；
(4)本发明提供的控制系统可以通过采集患者患肢的残余力，让患者在训练中更有主动性，并能够感受到，提高患者残余训练积极性，增加康复训练数据准确性。
附图说明
图1为本发明实施例上肢康复机器人控制系统框图；
图2为本发明实施例上肢康复机器人控制系统主动控制模式流程图；
图3为本发明实施例上肢康复机器人控制系统被动控制模式流程图；
图4为本发明实施例上肢康复机器人控制系统助动控制模式流程图；
图5为本发明实施例上肢康复机器人控制系统阻抗控制模式流程图。
具体实施方式
下面对本发明的实施例作详细说明，本实施例在以本发明技术方案为前提下进行实施，给出了详细的实施方式和具体的操作过程，但本发明的保护范围不限于下述的实施例。
本发明实施例所述的上肢康复机器人控制系统为以太网总线型拓扑结构，其结构框图见图1，包括工控机以及搭载在工控机中运行的控制系统软件和与工控机连接的液晶显示器、鼠标键盘以及总线控制模块；所述总线控制模块通过内部总线与一路PWM模块、模拟量模块和数字量模块连接，所述总线控制模块通过以太网线与5路伺服驱动器连接。
所述5路伺服驱动器通过电缆分别与5路直流伺服电机相连，控制机械臂上的控制前臂旋前/旋后、肘关节屈/伸、肩关节水平内收/外展、肩关节屈/伸、肩关节内旋/外旋电机旋转。
所述5路直流伺服电机上的绝对值编码器通过电缆连接5路伺服驱动器，5路伺服驱动器通过总线控制模块与工控机连接，提供数据给工控机内软件进行数据处理。
所述1路PWM模块通过电缆连接到舵机，实现对机械臂上腕关节屈/伸控制。
所述模拟量模块连接舵机末端的电位计将实际电机位置值通过模拟量模块传输到总线控制模块。
所述模拟量模块连接六维力传感器，将机械臂末端的空间力和力矩传输到总线控制模块，总线控制模块将模拟量数据通过以太网总线传输到工控机，提供给工控机内软件进行数据处理。
所述数字量模块连接急停开关和限位开关，所述数字量模块将急停开关和限位开关的数字量数据采集到总线控制模块，所述总线控制模块将模拟量数据通过以太网总线传输到工控机，提供给工控机内软件进行数据处理。
所述控制系统软件包括系统任务管理模块、运动控制模块、数据采集处理模块、逻辑处理模块、界面显示模块和总线处理模块；所述系统任务管理模块、运动控制模块、数据采集处理模块、逻辑处理模块、界面显示模块和总线处理模块集成在同一个控制系统软件中；所述系统任务管理模块对运动控制模块、数据采集处理模块、逻辑处理模块、界面显示模块和总线处理模块进行任务分配，所述运动控制模块通过内置轨迹运动程序对5路直流伺服电机和舵机的运动进行控制，所述数据采集处理模块对采集到的5路直流伺服电机绝对值编码器数据和舵机电位计数据进行处理，所述逻辑处理模块对接收到的数字量模块数据进行逻辑处理，所述界面显示模块将软件控制系统中需要显示的数据处理并发送到人机交互设备，所述总线处理模块将运动控制模块中产生的控制指令发送给总线控制模块，并将从总线控制模块中接收到的数据发送给运动控制模块、数据采集处理模块、逻辑处理模块和界面显示模块。
所述运动控制模块中内置的轨迹运动程序包括平面轨迹运动程序、平面阻抗/助动轨迹运动程序、三维轨迹运动程序以及三维阻抗/助动轨迹运动程序。
所述数据采集处理模块包括关节实际角度数据处理程序和六维力传感器数据处理程序，所述关节实际角度数据处理程序将采集到的编码器数据转换成关节的实际转动角度值，所述六维力传感器数据处理程序将采集到的六维力数据通过矩阵转换，转换成实际在X,Y,Z方向的力值和力矩值。
所述鼠标键盘用于在液晶显示器界面上进行操作，所述液晶显示器显示控制系统软件提供给用户的互动训练模式，所述控制系统软件根据用户选择的互动训练模式执行相应的轨迹运动程序。
所述控制系统软件提供给用户的互动训练模式包括主动控制模式、被动控制模式、助动控制模式和阻抗控制模式。
本实施例的上肢被动康复机器人控制系统中运行根据康复治疗师治疗方案规划过的轨迹运动程序，所述轨迹运动程序在液晶显示器上通过游戏的形式进行展现，游戏的内容是模拟正常生活环境中手臂的常规活动如吃饭，喝水，采摘，移动物体等。目的是增强患者的参与感，提高训练效果，通过模拟日常生活动作，让患者更早回归到正常生活中。
上肢被动康复机器人控制系统根据鼠标键盘的选择分别执行主动控制、被动控制、助动控制及阻抗控制。上肢被动康复机器人控制系统在主动控制模式下，执行预先设置好的游戏程序，患者患肢带动机械臂运动，参与游戏的互动。主动控制模式的工作流程图见图2，具体为：在液晶显示屏上选择主动控制模式，选择游戏是否进行，不进行游戏时则回到模式选择界面，当游戏进行时，患者带动患肢运动，带动5路直流伺服电机转动，从而带动机械臂，并根据机械臂的移动情况作出判断，当机械臂移动时，5路直流伺服电机上的绝对值编码器及电位计数据实时传输到工控机中的数据采集处理模块中，数据采集处理将对应关节在关节坐标系下的实际角度转换成笛卡尔坐标系下的空间位置，该空间位置的变换对应液晶显示器上目标的位置移动，实现主动控制下互动的效果，上肢被动康复机器人控制系统同时记录下训练中的数据信息，康复治疗师根据统计的数据分析康复训练效果及制定下一阶段的康复计划；若机械臂不移动，则控制系统记录并统计游戏环境下患者操作情况，直至训练结束。
上肢被动康复机器人控制系统在被动控制模式下，根据预先设定好的游戏程序，由机械臂带动患者患肢进行活动。被动控制模式的工作流程图见图3，具体为：在液晶显示屏上选择被动控制模式，并选择游戏是否执行，当游戏不执行时，回到模式选择界面，当游戏执行时，根据选定的游戏程序路径描述的是笛卡尔坐标系下机械臂末端位置的空间轨迹，工控机中的运动控制模块中的轨迹运动程序通过逆解将笛卡尔坐标系下的空间轨迹上点的位置转换成机械臂上对应关节的指令角度，同时5路直流伺服电机转动的实际角度值会通过绝对值编码器和电位计传输给工控机中的运动控制模块，运动控制模块将绝对值编码器和电位计反馈的实际值与从游戏程序中获得转换后的指令位置值进行比较，当比较处理完成时，做位置值的补偿，最终运动控制模块中的轨迹运动程序通过总线将补偿后的关节角度值发送给5路伺服驱动器和一路PWM模块，控制5路直流伺服电机转动确定的角度，当比较处理未完成时，再次进行比较处理，直至比较处理完成，完成位置值的补偿，控制系统同时记录下训练中的数据信息，康复治疗师根据统计的数据分析康复训练效果及制定下一阶段的康复计划。
上肢被动康复机器人控制系统在助动控制模式下，上肢被动康复机器人控制系统同时结合主动控制、被动控制及力控制原理，根据预先设定好的游戏程序，由机械臂带动患者患肢进行活动的同时也将患者患肢的残余力充分利用，使患者得到更加精确的康复治疗。助动控制模式的工作流程图见图4，具体为：在液晶显示器界面上选择助动控制模式，并确定是否执行游戏程序，当不执行游戏程序时，返回模式选择界面，当选择执行游戏程序时，根据游戏程序中路径描述的笛卡尔坐标系下机械臂末端位置的空间轨迹，工控机中的运动控制模块中的轨迹运动程序通过逆解将笛卡尔坐标系下的空间轨迹上点的位置转换成机械臂上对应关节的指令角度，同时5路直流伺服电机转动的实际角度值会通过绝对值编码器和电位计传输给工控机中的运动控制模块，运动控制模块将绝对值编码器和电位计反馈的实际值与从游戏程序中获得转换后的指令位置值进行比较，做位置值的补偿，得到位置环的期望输入值，另外，六维力传感器将患者患肢末端施加在机械臂上空间方向的3个力Fx，Fy，Fz和3个方向的力矩Mx，MY，MZ数据反馈给工控机中的运动控制模块，转换为位置环、速度环和电流环控制方程应用参数，然后将各关节位置环期望位置值与位置环、速度环和电流环控制方程应用参数采用助动控制闭环数据处理，并判断数据处理是否完成，若数据处理完成，则完成力矩模式下控制电机转动确定的角度，带动机械臂关节转动确定角度，控制系统同时统计游戏环境下患者操作情况；若数据处理未完成，则返回助动控制闭环数据处理步骤，继续进行数据处理，直至游戏结束。
上肢被动康复机器人控制系统在阻抗控制模式下，上肢被动康复机器人控制系统同时结合主动控制、被动控制及力控制原理，根据预先设定好的游戏程序，由机械臂带动患者患肢进行活动的同时也将患者患肢的残余力充分利用，使患者得到更加精确的康复治疗。阻抗控制模式的工作流程图见图5，具体为：通过液晶显示器界面选择阻抗控制模式，并选择是否执行相应的游戏程序，若不执行该游戏，则返回模式选择界面，若执行游戏，则根据游戏程序中路径描述的笛卡尔坐标系下机械臂末端位置的空间轨迹，工控机中的运动控制模块中的轨迹运动程序通过逆解将笛卡尔坐标系下的空间轨迹上点的位置转换成机械臂上对应关节的指令角度，同时5路直流伺服电机转动的实际角度值会通过绝对值编码器和电位计传输给工控机中的运动控制模块，运动控制模块将绝对值编码器和电位计反馈的实际值与从游戏程序中获得转换后的指令位置值进行比较，做位置值的补偿，得到位置环的期望输入值，另外，六维力传感器将患者患肢末端施加在机械臂上空间方向的3个力Fx，Fy，Fz和3个方向的力矩Mx，MY，MZ数据反馈给工控机中的运动控制模块，转换为位置环、速度环和电流环控制方程应用参数，然后将各关节位置环期望位置值与位置环、速度环和电流环控制方程应用参数采用阻抗控制闭环数据处理，并判断数据处理是否完成，若数据处理完成，则完成力矩模式下控制电机转动确定的角度，带动机械臂关节转动确定角度，控制系统同时统计游戏环境下患者操作情况；若数据处理未完成，则返回阻抗控制闭环数据处理步骤，继续进行数据处理，直至游戏结束。
以上所述仅为本发明的较佳实施例而已，并不用以限制本发明，凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等，均应包含在本发明的保护范围之内。

Claims (12)

1.一种六自由度的上肢康复机器人控制系统，其特征在于，所述控制系统为以太网总线型拓扑结构，包括控制系统软件、工控机和与工控机连接的人机交互设备以及总线控制模块；
所述控制系统软件搭载在工控机中运行；
所述人机交互设备连接工控机，用于显示并选择控制系统软件提供给用户的互动训练模式，所述控制系统软件根据用户选择的互动训练模式执行相应的轨迹运动程序；
所述总线控制模块通过内部总线与一路PWM模块、模拟量模块和数字量模块连接，所述总线控制模块通过以太网线与5路伺服驱动器连接；
所述5路伺服驱动器通过电缆分别与5路直流伺服电机相连，控制机械臂上的控制前臂旋前/旋后、肘关节屈/伸、肩关节水平内收/外展、肩关节屈/伸、肩关节内旋/外旋电机旋转；
所述5路直流伺服电机上的绝对值编码器通过电缆连接5路伺服驱动器，5路伺服驱动器通过总线控制模块与工控机连接，提供数据给工控机内软件进行数据处理；
所述1路PWM模块通过电缆连接到舵机，实现对机械臂上腕关节屈/伸控制；
所述模拟量模块连接舵机末端的电位计将实际电机位置值通过模拟量模块传输到总线控制模块；
所述模拟量模块连接六维力传感器，将机械臂末端的空间力和力矩传输到总线控制模块，总线控制模块将模拟量数据通过以太网总线传输到工控机，提供给工控机内软件进行数据处理；
所述数字量模块连接急停开关和限位开关，所述数字量模块将数字量数据采集到总线控制模块，总线控制模块将模拟量数据通过以太网总线传输到工控机，提供给工控机内软件进行数据处理。
2.根据权利要求1所述的一种六自由度的上肢康复机器人控制系统，其特征在于，所述控制系统软件包括系统任务管理模块、运动控制模块、数据采集处理模块、逻辑处理模块、界面显示模块和总线处理模块；所述系统任务管理模块对运动控制模块、数据采集处理模块、逻辑处理模块、界面显示模块和总线处理模块进行任务分配，所述运动控制模块通过内置轨迹运动程序对5路直流伺服电机和舵机的运动进行控制，所述数据采集处理模块对采集到的5路直流伺服电机绝对值编码器数据和舵机电位计数据进行处理，所述逻辑处理模块对接收到的数字量模块数据进行逻辑处理，所述界面显示模块将控制系统软件中需要显示的数据处理并发送到人机交互设备，所述总线处理模块将运动控制模块中产生的控制指令发送给总线控制模块，并将从总线控制模块中接收到的数据发送给运动控制模块、数据采集处理模块、逻辑处理模块和界面显示模块。
3.根据权利要求2所述的一种六自由度的上肢康复机器人控制系统，其特征在于，所述系统任务管理模块、运动控制模块、数据采集处理模块、逻辑处理模块、界面显示模块和总线处理模块集成在同一个控制系统软件中。
4.根据权利要求2所述的一种六自由度的上肢康复机器人控制系统，其特征在于，所述运动控制模块中的内置轨迹运动程序为模拟正常生活环境中手臂常规活动的游戏程序。
5.根据权利要求4所述的一种六自由度的上肢康复机器人控制系统，其特征在于，所述内置轨迹运动程序包括平面轨迹运动程序、平面阻抗/助动轨迹运动程序、三维轨迹运动程序以及三维阻抗/助动轨迹运动程序。
6.根据权利要求2或3所述的一种六自由度的上肢康复机器人控制系统，其特征在于，所述数据采集处理模块包括关节实际角度数据处理程序和六维力传感器数据处理程序，所述关节实际角度数据处理程序将采集到的编码器数据转换成关节的实际转动角度值，所述六维力传感器数据处理程序将采集到的六维力数据通过矩阵转换，转换成实际在X,Y,Z方向的力值和力矩值。
7.根据权利要求1所述的一种六自由度的上肢康复机器人控制系统，其特征在于，所述人机交互设备包括鼠标键盘和液晶显示器，所述鼠标键盘用于在液晶显示器界面上进行操作，所述液晶显示器显示控制系统软件提供给用户的互动训练模式。
8.根据权利要求1所述的一种六自由度的上肢康复机器人控制系统，其特征在于，所述控制系统软件提供给用户的互动训练模式包括主动控制模式、被动控制模式、助动控制模式和阻抗控制模式。
9.根据权利要求8所述的一种六自由度的上肢康复机器人控制系统，其特征在于，所述主动控制模式对应的轨迹运动程序执行过程为：患者患肢带动机械臂运动，患者带动患肢运动过程中，带动5路直流伺服电机转动，绝对值编码器及电位计数据实时传输到数据采集处理模块中，数据采集处理模块将对应关节在关节坐标系下的实际角度转换成笛卡尔坐标系下的空间位置，该空间位置的变换对应人机交互界面上目标的位置移动，实现主动控制下互动的效果，控制系统同时记录下训练中的数据信息。
10.据权利要求8所述的一种六自由度的上肢康复机器人控制系统，其特征在于，所述被动控制模式对应的轨迹运动程序执行过程为：运动控制模块通过逆解将笛卡尔坐标系下的空间轨迹上点的位置转换成机械臂上对应关节的指令角度，同时5路直流伺服电机转动的实际角度值会通过绝对值编码器和电位计传输给软件控制系统中的运动控制模块，运动控制模块将绝对值编码器和电位计反馈的实际值与从轨迹运动程序中获得转换后的指令位置值进行比较，做位置值的补偿，最终运动控制模块通过总线将补偿后的关节角度值分别发送给5路伺服驱动器和1路PWM模块，控制5路直流伺服电机转动确定的角度，控制系统同时记录下训练中的数据信息。
11.据权利要求8所述的一种六自由度的上肢康复机器人控制系统，其特征在于，所述助动控制模式对应的轨迹运动程序执行过程为：根据轨迹运动程序中路径描述的笛卡尔坐标系下机械臂末端位置的空间轨迹，运动控制模块通过逆解将笛卡尔坐标系下的空间轨迹上点的位置转换成机械臂上对应关节的指令角度，同时5路直流伺服电机转动的实际角度值通过绝对值编码器和电位计传输给运动控制模块，运动控制模块将绝对值编码器和电位计反馈的实际值与从轨迹运动程序中获得转换后的指令位置值进行比较，做位置值的补偿，得到位置环的期望输入值，另外，六维力传感器将患者患肢末端施加在机械臂上空间方向的3个力Fx，Fy，Fz和3个方向的力矩Mx，MY，MZ数据反馈给运动控制模块，转换为轨迹控制程序中位置环、速度环和电流环控制方程应用参数，完成力矩模式下控制电机转动确定的角度，带动机械臂关节转动确定角度，控制系统同时记录下训练中的数据信息。
12.据权利要求8所述的一种六自由度的上肢康复机器人控制系统，其特征在于，所述阻抗控制模式对应的轨迹运动程序执行过程为：根据轨迹运动程序中路径描述的笛卡尔坐标系下机械臂末端位置的空间轨迹，运动控制模块通过逆解将笛卡尔坐标系下的空间轨迹上点的位置转换成机械臂上对应关节的指令角度，同时5路直流伺服电机转动的实际角度值会通过绝对值编码器和电位计传输给运动控制模块，运动控制模块将绝对编码器和电位计反馈的实际值与从轨迹运动程序中获得转换后的指令位置值进行比较，做位置值的补偿，得到位置环的期望输入值，另外，六维力传感器将患者患肢末端施加在机械臂上空间方向的3个力Fx，Fy，Fz和3个方向的力矩Mx，MY，MZ数据反馈给运动控制模块，转换为位置环、速度环和电流环控制方程应用参数，完成力矩模式下控制电机转动确定的角度，带动机械臂关节转动确定角度。
CN201810173731.4A 2018-03-02 2018-03-02 一种六自由度的上肢康复机器人控制系统 Active CN108524187B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810173731.4A CN108524187B (zh) 2018-03-02 2018-03-02 一种六自由度的上肢康复机器人控制系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810173731.4A CN108524187B (zh) 2018-03-02 2018-03-02 一种六自由度的上肢康复机器人控制系统

Publications (2)

Publication Number Publication Date
CN108524187A true CN108524187A (zh) 2018-09-14
CN108524187B CN108524187B (zh) 2019-12-17

Family

ID=63486480

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810173731.4A Active CN108524187B (zh) 2018-03-02 2018-03-02 一种六自由度的上肢康复机器人控制系统

Country Status (1)

Country Link
CN (1) CN108524187B (zh)

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109529274A (zh) * 2018-11-13 2019-03-29 南京邮电大学 基于冗余机械臂上肢关节主动康复系统及其训练方法
CN110384601A (zh) * 2019-07-25 2019-10-29 吉林农业科技学院 仿步行膝关节康复治疗机器人及其控制系统
CN110801239A (zh) * 2019-11-20 2020-02-18 上海交通大学 一种上肢多关节等速训练测试装置
CN111388269A (zh) * 2020-03-10 2020-07-10 上海电气集团股份有限公司 基于can总线的上肢康复机器人及其控制系统
CN111481888A (zh) * 2020-04-21 2020-08-04 福州大学 一种肌力训练动力头控制方法及装置
CN111558202A (zh) * 2019-02-14 2020-08-21 上银科技股份有限公司 上肢训练系统及控制方法
CN112716750A (zh) * 2020-12-24 2021-04-30 湖北英特搏智能机器有限公司 基于三维力传感器的康复机器人力交互控制方法
US11123608B2 (en) 2019-03-05 2021-09-21 Hiwin Technologies Corp. Upper limb training system and control method thereof
CN114129392A (zh) * 2021-12-07 2022-03-04 山东大学 可调控末端指尖力的自适应冗余驱动外骨骼康复机器人

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102862161A (zh) * 2012-09-10 2013-01-09 王伟栋 一种基于现场总线的pac工业机器人控制系统
CN103522290A (zh) * 2013-10-14 2014-01-22 上海胖熊信息技术有限公司 基于现场总线的分布式机器人控制系统
CN104027218A (zh) * 2014-06-05 2014-09-10 电子科技大学 一种康复机器人控制系统和方法
CN104731107A (zh) * 2015-03-26 2015-06-24 北京特种机械研究所 一种电动六自由度运动平台高精度控制系统及控制方法
CN204431264U (zh) * 2014-12-05 2015-07-01 杭州新松机器人自动化有限公司 基于EtherCAT的智能工业机器人总线模块
CN106602940A (zh) * 2016-11-25 2017-04-26 安阳工学院 上肢康复机器人用无刷直流电机控制器
CN106974795A (zh) * 2017-03-24 2017-07-25 华中科技大学 一种欠驱动上肢康复机器人控制系统
CN107334600A (zh) * 2017-07-06 2017-11-10 哈工大机器人（合肥）国际创新研究院 一种多通道混合信号采集系统

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102862161A (zh) * 2012-09-10 2013-01-09 王伟栋 一种基于现场总线的pac工业机器人控制系统
CN103522290A (zh) * 2013-10-14 2014-01-22 上海胖熊信息技术有限公司 基于现场总线的分布式机器人控制系统
CN104027218A (zh) * 2014-06-05 2014-09-10 电子科技大学 一种康复机器人控制系统和方法
CN204431264U (zh) * 2014-12-05 2015-07-01 杭州新松机器人自动化有限公司 基于EtherCAT的智能工业机器人总线模块
CN104731107A (zh) * 2015-03-26 2015-06-24 北京特种机械研究所 一种电动六自由度运动平台高精度控制系统及控制方法
CN106602940A (zh) * 2016-11-25 2017-04-26 安阳工学院 上肢康复机器人用无刷直流电机控制器
CN106974795A (zh) * 2017-03-24 2017-07-25 华中科技大学 一种欠驱动上肢康复机器人控制系统
CN107334600A (zh) * 2017-07-06 2017-11-10 哈工大机器人（合肥）国际创新研究院 一种多通道混合信号采集系统

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109529274A (zh) * 2018-11-13 2019-03-29 南京邮电大学 基于冗余机械臂上肢关节主动康复系统及其训练方法
CN109529274B (zh) * 2018-11-13 2021-01-26 南京邮电大学 基于冗余机械臂上肢关节主动康复系统及其训练方法
CN111558202A (zh) * 2019-02-14 2020-08-21 上银科技股份有限公司 上肢训练系统及控制方法
CN111558202B (zh) * 2019-02-14 2021-06-29 上银科技股份有限公司 上肢训练系统及控制方法
US11123608B2 (en) 2019-03-05 2021-09-21 Hiwin Technologies Corp. Upper limb training system and control method thereof
CN110384601A (zh) * 2019-07-25 2019-10-29 吉林农业科技学院 仿步行膝关节康复治疗机器人及其控制系统
CN110801239A (zh) * 2019-11-20 2020-02-18 上海交通大学 一种上肢多关节等速训练测试装置
CN110801239B (zh) * 2019-11-20 2022-06-17 上海交通大学 一种上肢多关节等速训练测试装置
CN111388269A (zh) * 2020-03-10 2020-07-10 上海电气集团股份有限公司 基于can总线的上肢康复机器人及其控制系统
CN111481888A (zh) * 2020-04-21 2020-08-04 福州大学 一种肌力训练动力头控制方法及装置
CN112716750A (zh) * 2020-12-24 2021-04-30 湖北英特搏智能机器有限公司 基于三维力传感器的康复机器人力交互控制方法
CN112716750B (zh) * 2020-12-24 2022-09-16 湖北英特搏智能机器有限公司 基于三维力传感器的康复机器人力交互控制方法
CN114129392A (zh) * 2021-12-07 2022-03-04 山东大学 可调控末端指尖力的自适应冗余驱动外骨骼康复机器人

Also Published As

Publication number Publication date
CN108524187B (zh) 2019-12-17

Similar Documents

Publication Publication Date Title
CN108524187A (zh) 一种六自由度的上肢康复机器人控制系统
CN103558786B (zh) 基于嵌入Android移动终端及FPGA的手部功能康复机器人人机交互控制系统
US11771613B2 (en) Robot system for active and passive upper limb rehabilitation training based on force feedback technology
CN103735389B (zh) 一种手指间协调性训练康复装置
CN102716002A (zh) 坐卧式下肢康复机器人及相应的被动训练控制方法
CN108814894A (zh) 基于视觉人体位姿检测的上肢康复机器人系统及使用方法
CN109330819B (zh) 主从式上肢外骨骼康复机器人控制系统及其控制方法
CN102309393A (zh) 外骨骼式上肢康复机器人
WO2016008109A1 (zh) 上肢康复机器人系统
CN105867130B (zh) 康复步行训练机器人的轨迹跟踪误差约束安全控制方法
CN101978940A (zh) 一种虚实结合的机器人辅助手指运动功能康复训练系统
CN110215676A (zh) 一种上肢双臂康复训练人机交互方法和系统
CN106974795B (zh) 一种欠驱动上肢康复机器人控制系统
CN107280910B (zh) 一种基于数据采集的自主智能按摩器及操作方法
CN110013419A (zh) 一种双臂康复机器人及训练方法
CN109529274B (zh) 基于冗余机械臂上肢关节主动康复系统及其训练方法
CN102039031A (zh) 基于虚拟现实的手部多功能康复系统
CN209092068U (zh) 一种上肢综合评估与康复训练机器人
Kousidou et al. Task-orientated biofeedback system for the rehabilitation of the upper limb
CN109907936A (zh) 基于虚拟现实的上肢康复训练设备
CN115363907A (zh) 一种基于虚拟现实康复训练系统的康复决策方法
Masengo et al. A design of lower limb rehabilitation robot and its control for passive training
Tóth et al. 25 Post stroke shoulder-elbow physiotherapy with industrial robots
CN201267596Y (zh) 下肢步态矫正器控制装置
Loureiro et al. Design of the ROBIN system: whole-arm multi-model sensorimotor environment for the rehabilitation of brain injuries while sitting or standing

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
TR01 Transfer of patent right

Effective date of registration: 20200914

Address after: 230000 4th floor, building 3, block C, intelligent equipment science and Technology Park, 3963 Susong Road, Hefei Economic and Technological Development Zone, Anhui Province

Patentee after: Hefei Harbin gonglixun Intelligent Technology Co., Ltd

Address before: 236000 Anhui city of Hefei Province Economic and Technological Development Zone Cuiwei Road No. 6 Haiheng building room 6012

Patentee before: HRG INTERNATIONAL INSTITUTE FOR RESEARCH & INNOVATION

TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20210507

Address after: 230000 3rd floor, No.4 workshop, intelligent science and Technology Park, no.3963 Susong Road, Hefei Economic and Technological Development Zone, Anhui Province

Patentee after: Anhui Hagong Peugeot medical and Health Industry Co.,Ltd.

Address before: 230000 4th floor, building 3, Zone C, intelligent equipment science and Technology Park, 3963 Susong Road, Hefei Economic and Technological Development Zone, Anhui Province

Patentee before: Hefei Harbin gonglixun Intelligent Technology Co., Ltd

TR01 Transfer of patent right