CN117697717A - Exoskeleton physical man-machine two-way interaction simulation system - Google Patents
Exoskeleton physical man-machine two-way interaction simulation system Download PDFInfo
- Publication number
- CN117697717A CN117697717A CN202311671118.2A CN202311671118A CN117697717A CN 117697717 A CN117697717 A CN 117697717A CN 202311671118 A CN202311671118 A CN 202311671118A CN 117697717 A CN117697717 A CN 117697717A
- Authority
- CN
- China
- Prior art keywords
- exoskeleton
- human
- muscle
- simulation
- 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.)
- Pending
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01D—MEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
- G01D21/00—Measuring or testing not otherwise provided for
- G01D21/02—Measuring two or more variables by means not covered by a single other subclass
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B5/00—Measuring for diagnostic purposes; Identification of persons
- A61B5/103—Measuring devices for testing the shape, pattern, colour, size or movement of the body or parts thereof, for diagnostic purposes
- A61B5/11—Measuring movement of the entire body or parts thereof, e.g. head or hand tremor or mobility of a limb
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B5/00—Measuring for diagnostic purposes; Identification of persons
- A61B5/24—Detecting, measuring or recording bioelectric or biomagnetic signals of the body or parts thereof
- A61B5/316—Modalities, i.e. specific diagnostic methods
- A61B5/369—Electroencephalography [EEG]
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B5/00—Measuring for diagnostic purposes; Identification of persons
- A61B5/68—Arrangements of detecting, measuring or recording means, e.g. sensors, in relation to patient
- A61B5/6801—Arrangements of detecting, measuring or recording means, e.g. sensors, in relation to patient specially adapted to be attached to or worn on the body surface
- A61B5/6802—Sensor mounted on worn items
-
- 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/0006—Exoskeletons, i.e. resembling a human figure
-
- 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/1628—Programme controls characterised by the control loop
- B25J9/163—Programme controls characterised by the control loop learning, adaptive, model based, rule based expert control
-
- 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/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
-
- G—PHYSICS
- G06—COMPUTING OR CALCULATING; COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/20—Design optimisation, verification or simulation
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04L—TRANSMISSION OF DIGITAL INFORMATION, e.g. TELEGRAPHIC COMMUNICATION
- H04L69/00—Network arrangements, protocols or services independent of the application payload and not provided for in the other groups of this subclass
- H04L69/16—Implementation or adaptation of Internet protocol [IP], of transmission control protocol [TCP] or of user datagram protocol [UDP]
- H04L69/161—Implementation details of TCP/IP or UDP/IP stack architecture; Specification of modified or new header fields
- H04L69/162—Implementation details of TCP/IP or UDP/IP stack architecture; Specification of modified or new header fields involving adaptations of sockets based mechanisms
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04L—TRANSMISSION OF DIGITAL INFORMATION, e.g. TELEGRAPHIC COMMUNICATION
- H04L69/00—Network arrangements, protocols or services independent of the application payload and not provided for in the other groups of this subclass
- H04L69/18—Multiprotocol handlers, e.g. single devices capable of handling multiple protocols
-
- 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)
- Health & Medical Sciences (AREA)
- Life Sciences & Earth Sciences (AREA)
- Physics & Mathematics (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Public Health (AREA)
- Veterinary Medicine (AREA)
- General Health & Medical Sciences (AREA)
- Animal Behavior & Ethology (AREA)
- Surgery (AREA)
- Molecular Biology (AREA)
- Medical Informatics (AREA)
- Heart & Thoracic Surgery (AREA)
- Biomedical Technology (AREA)
- Biophysics (AREA)
- Pathology (AREA)
- Computer Security & Cryptography (AREA)
- Computer Networks & Wireless Communication (AREA)
- Theoretical Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Signal Processing (AREA)
- Dentistry (AREA)
- Geometry (AREA)
- General Engineering & Computer Science (AREA)
- Evolutionary Computation (AREA)
- Physiology (AREA)
- Computer Hardware Design (AREA)
- Oral & Maxillofacial Surgery (AREA)
- Psychiatry (AREA)
- Psychology (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种外骨骼物理人机双向交互仿真系统,属于外骨骼机器人领域。本发明包括外骨骼人机系统、数据传输模块、仿真同步模块、智能算法模块、仿真可视化模块。与传统的纯仿真系统不同的是,本发明提出的仿真系统可以通过数据接口与外骨骼机器人相连,实现外骨骼机器人实际系统及其周围环境在仿真环境中的实时重构,并且,仿真环境中的模型可与真实的外骨骼机器人之间进行双向同步,实现高度实时反馈的物理人机双向交互仿真系统。
The invention discloses an exoskeleton physical human-machine two-way interactive simulation system, which belongs to the field of exoskeleton robots. The invention includes an exoskeleton human-machine system, a data transmission module, a simulation synchronization module, an intelligent algorithm module, and a simulation visualization module. Different from traditional pure simulation systems, the simulation system proposed by the present invention can be connected to the exoskeleton robot through a data interface to realize real-time reconstruction of the actual system of the exoskeleton robot and its surrounding environment in the simulation environment, and in the simulation environment The model can perform two-way synchronization with the real exoskeleton robot, realizing a physical human-machine two-way interactive simulation system with high real-time feedback.
Description
技术领域Technical field
本发明属于智能穿戴设备领域,特别是外骨骼系统。The invention belongs to the field of intelligent wearable devices, especially exoskeleton systems.
背景技术Background technique
外骨骼机器人技术是一种典型的多学科交叉的技术,涉及临床医学、康复医学、机械设计、电路系统、信息处理、移动计算、控制算法等多个学科的专业知识。按照应用对象可以分为针对健康人能力增强的助力外骨骼机器人和针对医疗康复训练的医用外骨骼机器人。而医用外骨骼机器人又可分为两大类,一类是针对医院场景使用的康复训练机器人,一类是针对家庭和个人使用的助行外骨骼机器人。Exoskeleton robot technology is a typical multi-disciplinary technology, involving professional knowledge from multiple disciplines such as clinical medicine, rehabilitation medicine, mechanical design, circuit systems, information processing, mobile computing, and control algorithms. According to the application objects, it can be divided into power-assisted exoskeleton robots for healthy people's ability enhancement and medical exoskeleton robots for medical rehabilitation training. Medical exoskeleton robots can be divided into two categories: one is rehabilitation training robots for hospital scenarios, and the other is walking assistance exoskeleton robots for home and personal use.
外骨骼机器人作为一种典型的人机耦合性较强的穿戴式智能系统,其与穿戴者之间存在实时的交互过程。由于穿戴者的个体差异较大,为了得到更加舒适自然的步行过程,外骨骼机器人需要与穿戴者进行双向交互和相互适应,因此对其感知识别、认知决策、运动规划和人机交互等技术有较高的要求。As a typical wearable intelligent system with strong human-machine coupling, exoskeleton robots have a real-time interaction process with the wearer. Due to the large individual differences between the wearers, in order to obtain a more comfortable and natural walking process, the exoskeleton robot needs to have two-way interaction and mutual adaptation with the wearer. Therefore, it requires technologies such as perception recognition, cognitive decision-making, motion planning, and human-computer interaction. There are higher requirements.
外骨骼机器人作为一种典型的在真实环境中运动的穿戴式智能系统,其与周围的环境之间存在实时的交互过程。由于外骨骼人机系统所面临的环境是实时动态变化的,且时刻存在一些未知情况,因此对外骨骼机器人对地形环境的感知识别、认知决策、运动规划、动态适应等技术有较高的要求。As a typical wearable intelligent system that moves in a real environment, exoskeleton robots have real-time interaction processes with the surrounding environment. Since the environment faced by the exoskeleton human-machine system is dynamically changing in real time, and there are some unknown situations at all times, there are high requirements for the exoskeleton robot's perception and recognition of the terrain environment, cognitive decision-making, motion planning, dynamic adaptation and other technologies. .
由于开发外骨骼机器人需要机械、计算机、嵌入式、人工智能、控制等多学科方向的技术人才合作,其开发难度大,开发周期往往较长。并且一旦设计完成,对其功能的测试和迭代更新也需要大量的数据与结果验证,而实际的临床测试过程往往复杂且面临诸多困难。因此,构建外骨骼机器人的仿真测试系统,将外骨骼机器人的结构模型、穿戴者模型以及所面临的环境信息进行实时采集存储,并根据此信息构建外骨骼机器人的双向交互仿真系统具有重要的意义,通过对测试过程的记录和模拟并施加各种不同的感知、决策与控制算法可提升外骨骼机器人的开发效率,缩短开发周期,提升测试效率等。Since the development of exoskeleton robots requires the cooperation of technical talents from multiple disciplines such as mechanics, computers, embedded, artificial intelligence, and control, its development is difficult and the development cycle is often long. And once the design is completed, testing and iterative updates of its functions also require a large amount of data and result verification, and the actual clinical testing process is often complex and faces many difficulties. Therefore, it is of great significance to build a simulation test system for exoskeleton robots, collect and store the structural model, wearer model and environmental information of exoskeleton robots in real time, and build a two-way interactive simulation system for exoskeleton robots based on this information. , by recording and simulating the test process and applying various perception, decision-making and control algorithms, the development efficiency of exoskeleton robots can be improved, the development cycle can be shortened, and testing efficiency can be improved.
公开号CN113608451A的中国专利“基于ROS的仿真控制平台及外骨骼机器人仿真控制系统”公开了一种基于ROS的仿真控制平台及外骨骼机器人仿真控制系统,可与真实的外骨骼机器人进行数据交互并进行仿真控制。但该系统只提供了外骨骼人机之间的数据交互和控制算法,而忽略了环境信息对外骨骼人机系统的影响,其应用范围限制较大。The Chinese patent "ROS-based simulation control platform and exoskeleton robot simulation control system" with publication number CN113608451A discloses a ROS-based simulation control platform and exoskeleton robot simulation control system, which can interact with real exoskeleton robots and interact with data. Perform simulation control. However, this system only provides data interaction and control algorithms between exoskeleton man-machine and ignores the impact of environmental information on the exoskeleton man-machine system. Its application scope is relatively limited.
公开号CN112631148A的中国专利“一种外骨骼机器人平台通信协议及在线仿真控制系统”公开了一种外骨骼机器人平台的通信协议,基于该协议可构建外骨骼机器人客户端与远端服务器之间的通信过程,用于传输外骨骼机器人的传感信号和控制指令等。但是该专利未指定仿真系统的具体运行过程。The Chinese patent "An exoskeleton robot platform communication protocol and online simulation control system" with publication number CN112631148A discloses a communication protocol for the exoskeleton robot platform. Based on this protocol, a communication protocol between the exoskeleton robot client and the remote server can be constructed. The communication process is used to transmit sensing signals and control instructions of the exoskeleton robot. However, the patent does not specify the specific operation process of the simulation system.
公开号CN105892626A的中国专利“用于虚拟现实环境中的下肢运动仿真控制设备”公开了一种下肢外骨骼机器人训练系统,可通过与虚拟现实环境进行交互来为康复训练过程提供更为丰富的训练内容,以提升患者的主动参与情况。但是该专利仅针对计算机所构造的虚拟环境提供信息交互和仿真互动的过程,对外骨骼机器人所面临的现实环境在仿真环境中的情况未做进一步的设计。The Chinese patent "Lower Limb Movement Simulation Control Equipment for Virtual Reality Environment" with publication number CN105892626A discloses a lower limb exoskeleton robot training system that can provide richer training for the rehabilitation training process by interacting with the virtual reality environment. content to enhance patients’ active participation. However, this patent only provides the process of information interaction and simulation interaction for the virtual environment constructed by the computer, and does not make further design of the real environment faced by the exoskeleton robot in the simulation environment.
综上可得,当前外骨骼机器人的仿真系统主要存在以下几个问题:To sum up, the current exoskeleton robot simulation system mainly has the following problems:
1.仿真环境中的仿真模型只针对外骨骼机器人系统,对穿戴者本身的状态信息建模还不够;1. The simulation model in the simulation environment is only for the exoskeleton robot system, and it is not enough to model the status information of the wearer itself;
2.仿真环境中的地形等环境信息大多为虚拟构造的环境,没有针对外骨骼机器人面临的真实环境信息进行建模;2. Most of the environmental information such as terrain in the simulation environment is a virtual constructed environment, and there is no modeling of the real environmental information faced by the exoskeleton robot;
3.仿真环境与外骨骼人机系统之间的交互方式单一,仅仅停留在传感和控制指令的数据传输上,仿真模型与真实外骨骼人机系统的同步性较差。3. The interaction method between the simulation environment and the exoskeleton human-machine system is single, only focusing on the data transmission of sensing and control instructions. The synchronization between the simulation model and the real exoskeleton human-machine system is poor.
发明内容Contents of the invention
本发明解决了现有技术中仿真环境中的仿真模型只针对外骨骼机器人系统,对穿戴者本身的状态信息建模还不够;仿真环境中的地形等环境信息大多为虚拟构造的环境,没有针对外骨骼机器人面临的真实环境信息进行建模;仿真环境与外骨骼人机系统之间的交互方式单一,仅仅停留在传感和控制指令的数据传输上,仿真模型与真实外骨骼人机系统的同步性较差的技术问题。The present invention solves the problem that in the prior art, the simulation model in the simulation environment is only for the exoskeleton robot system, and is not enough to model the state information of the wearer itself; most of the environmental information such as terrain in the simulation environment is a virtual constructed environment, which is not specific to the exoskeleton robot system. The real environment information faced by the exoskeleton robot is modeled; the interaction method between the simulation environment and the exoskeleton human-machine system is single, only focusing on the data transmission of sensing and control instructions. The interaction between the simulation model and the real exoskeleton human-machine system Technical issues with poor synchronization.
针对需要解决的技术问题,本发明技术方案为一种外骨骼物理人机双向交互仿真系统,该系统包括:外骨骼人机系统、数据采集模块、仿真同步模块、智能算法模块、仿真可视化模块;In view of the technical problems that need to be solved, the technical solution of the present invention is an exoskeleton physical human-machine two-way interactive simulation system. The system includes: an exoskeleton human-machine system, a data acquisition module, a simulation synchronization module, an intelligent algorithm module, and a simulation visualization module;
所述外骨骼人机系统包括:外骨骼机器人,外骨骼机器人由穿戴者穿着,外骨骼机器人的骨架模仿人体腰部以下的肢体;The exoskeleton human-machine system includes: an exoskeleton robot, the exoskeleton robot is worn by the wearer, and the skeleton of the exoskeleton robot imitates the limbs below the waist of the human body;
所述数据采集模块包括:脑电信号采集模块、IMU传感器、关节角度传感器、交互力传感器、压力传感器、深度相机、IMU姿态传感器,所述脑电信号采集模块穿戴于人体头部;所述IMU传感器、关节角度传感器、交互力传感器、压力传感器、深度相机都设置有外骨骼机器人上,所述IMU姿态传感器设置有穿戴外骨骼机器人的穿戴者身上,所述IMU传感器检测外骨骼的姿态,所述交互力传感器检测穿戴者给外骨骼施加的力,所述压力传感器检测外骨骼脚底压力,所述IMU姿态传感器检测人体各个部分的姿态,所述深度相机采集穿戴者前方的路面情况;The data acquisition module includes: an EEG signal acquisition module, an IMU sensor, a joint angle sensor, an interactive force sensor, a pressure sensor, a depth camera, and an IMU attitude sensor. The EEG signal acquisition module is worn on the human head; the IMU Sensors, joint angle sensors, interactive force sensors, pressure sensors, and depth cameras are all installed on the exoskeleton robot. The IMU attitude sensor is installed on the wearer of the exoskeleton robot. The IMU sensor detects the attitude of the exoskeleton, so The interactive force sensor detects the force exerted by the wearer on the exoskeleton, the pressure sensor detects the pressure on the soles of the exoskeleton, the IMU posture sensor detects the posture of each part of the human body, and the depth camera collects the road conditions in front of the wearer;
所述仿真同步模块,在真实环境中的外骨骼人机系统和在虚拟环境中的仿真模型之前建立数据交换的通道,通过基于Ethernet的网络通信协议建立仿真环境与物理人机系统之间的通信协议并在两者之间进行数据传输;The simulation synchronization module establishes a data exchange channel between the exoskeleton human-machine system in the real environment and the simulation model in the virtual environment, and establishes communication between the simulation environment and the physical human-machine system through an Ethernet-based network communication protocol. protocol and transfer data between the two;
所述智能算法模块中包括:感知与识别模块、认知与决策模块、规划与控制模块;其中感知与识别模块用于从获取到的传感数据中对地形环境、人机运动状态等进行识别和分析;认知与决策模块用于根据当前人机系统所处环境和运动状态来对后续的运动路径进行决策;规划与控制模块用于根据前述的认知决策结果规划人机系统的运动模式并控制人机系统完成运动;The intelligent algorithm module includes: perception and recognition module, cognition and decision-making module, planning and control module; wherein the perception and recognition module is used to identify the terrain environment, human-machine motion status, etc. from the acquired sensor data. and analysis; the cognition and decision-making module is used to make decisions on subsequent motion paths based on the current environment and motion state of the human-machine system; the planning and control module is used to plan the motion mode of the human-machine system based on the aforementioned cognitive decision-making results And control the human-machine system to complete the movement;
所述仿真可视化模块包括:数据显示模块、算法仿真可视化模块、仿真过程回放模块;其中数据显示模块显示所有来自外骨骼物理人机系统的数据和在仿真过程中产生的中间状态数据;算法仿真可视化模块将仿真结果对外骨骼人机系统在仿真环境中的未来运动状态进行显示,以便于研发人员能够清晰地观察相应的算法感知、识别、规划和控制结果;仿真过程回放模块对所有已完成的历史仿真结果和真实的外骨骼物理人机系统的运动过程进行回放,以便于研发人员观察对比各类算法作用下的外骨骼人机系统状态差异。The simulation visualization module includes: a data display module, an algorithm simulation visualization module, and a simulation process playback module; the data display module displays all data from the exoskeleton physical human-machine system and intermediate state data generated during the simulation process; algorithm simulation visualization The module displays the simulation results on the future motion status of the exoskeleton human-machine system in the simulation environment, so that R&D personnel can clearly observe the corresponding algorithm perception, recognition, planning and control results; the simulation process playback module displays all completed history The simulation results and the movement process of the real exoskeleton physical human-machine system are played back, so that developers can observe and compare the state differences of the exoskeleton human-machine system under the action of various algorithms.
进一步的,所述感知与识别模块中的计算方法的具体计算步骤为:Further, the specific calculation steps of the calculation method in the perception and recognition module are:
感知与识别方法由质心估计器、坡度估计器以及Hill肌肉模型组成;其中质心估计器通过对人机系统运动时质心的变化得到其运动状态以及稳定性;坡度估计器估计外部环境中的坡度,以此进行外部坡道中的步态规划;The perception and recognition method consists of a center of mass estimator, a slope estimator and a Hill muscle model; the center of mass estimator obtains the motion state and stability of the human-machine system through changes in its center of mass when it moves; the slope estimator estimates the slope in the external environment, Use this for gait planning on external ramps;
首先在该外骨骼机器人中,踝关节为了更好的辅助行走被设定为了小范围内运动的被动关节,因此存在五个主动运动关节,分别为2个膝关节、2个髋关节、盆骨关节;而穿戴者则考虑10个主动运动关节的关节角度,分别为2个膝关节、2个髋关节、2个肩关节、2个肘关节、腰椎关节、盆骨关节;每个关节都设置有一个局部坐标系,而世界坐标系被设置在人机系统以外;First of all, in this exoskeleton robot, the ankle joint is set as a passive joint that can move within a small range in order to better assist walking. Therefore, there are five active joints, namely 2 knee joints, 2 hip joints, and pelvic joints. joints; while the wearer considers the joint angles of 10 active motion joints, namely 2 knee joints, 2 hip joints, 2 shoulder joints, 2 elbow joints, lumbar joints, and pelvic joints; each joint is set There is a local coordinate system, and the world coordinate system is set outside the human-machine system;
首先通过采集到的数据计算人机系统的质心位置;人机系统的质心求取公式如下:First, calculate the center of mass position of the human-machine system through the collected data; the formula for determining the center of mass of the human-machine system is as follows:
其中,C机为人机系统的质心位置,为从人的盆骨关节到世界坐标系原点的位移矢量,Mh与Me分别代表穿戴者与外骨骼机器人的质量,M为人机系统的总质量,Ch与Ce分别代表穿戴者与外骨骼机器人的质心位置,ε为设计的物理耦合模型;其中位移矢量/>通过穿戴者身上的IMU姿态传感器求得的数据得来;穿戴者的质心位置求取公式如下:Among them, C machine is the center of mass position of the human-machine system, is the displacement vector from the human pelvic joint to the origin of the world coordinate system, M h and M e represent the masses of the wearer and the exoskeleton robot respectively, M is the total mass of the human-machine system, C h and C e represent the wearer and the exoskeleton robot respectively. The center of mass position of the exoskeleton robot, ε is the designed physical coupling model; where the displacement vector /> It is obtained from the data obtained from the IMU attitude sensor on the wearer; the formula for determining the position of the wearer's center of mass is as follows:
H=[H1 H2 … H10]为穿戴者的转移矩阵,其中并以此类推;/>为相邻关节间的均匀过度矩阵,/>与/>分别为关节i到关节j的旋转矩阵和位移矢量,其中旋转矩阵由穿戴者身上的关节角度传感器测得的关节角度求得,而位移矢量由穿戴者身上的姿态传感器求得;/>为人体的运动学与静态参数,通过收集30个穿戴者的静态位姿用公式(2)求得;H=[H 1 H 2 …H 10 ] is the wearer’s transfer matrix, where And so on;/> is the uniform transition matrix between adjacent joints,/> with/> are the rotation matrix and displacement vector from joint i to joint j respectively, where the rotation matrix is obtained by the joint angle measured by the joint angle sensor on the wearer, and the displacement vector is obtained by the attitude sensor on the wearer;/> are the kinematics and static parameters of the human body, which are obtained by collecting the static postures of 30 wearers and using formula (2);
外骨骼机器人的质心位置求取公式如下:The formula for calculating the center of mass position of the exoskeleton robot is as follows:
E=[E1 E2 … E5]为其状态矩阵,其中并以此类推;/>为其运动学与静态参数;由于外骨骼机器人只考虑五个主动运动关节,因此其转移矩阵与运动学与静态参数为5阶矩阵;物理耦合模型ε求取公式如下:E=[E 1 E 2 ... E 5 ] is its state matrix, where And so on;/> are its kinematic and static parameters; since the exoskeleton robot only considers five active motion joints, its transfer matrix and kinematic and static parameters are fifth-order matrices; the formula for calculating the physical coupling model ε is as follows:
ε=RY(θlh)δ1+RY(θlk)δ2+RY(θrh)δ3+RY(θrk)δ4, (4)ε=R Y (θ lh )δ 1 +R Y (θ lk )δ 2 +R Y (θ rh )δ 3 +R Y (θ rk )δ 4 , (4)
其中,θlh、θlk、θrh、θrk分别为左髋、左膝、右髋、右膝的关节角度,RY(θi)表示关节i相对于y轴的旋转矩阵,通过关节角度传感器的角度数据求得;δj为权重,j=1,2,3,4,是通过外骨骼脚底压力传感器的数据经过实验得到的;Among them, θ lh , θ lk , θ rh , and θ rk are the joint angles of the left hip, left knee, right hip, and right knee respectively. R Y (θ i ) represents the rotation matrix of joint i relative to the y axis. Through the joint angle The angle data of the sensor is obtained; δ j is the weight, j = 1, 2, 3, 4, which is obtained through experiments from the data of the exoskeleton foot pressure sensor;
在经过上述步骤计算得到人机系统质心位置后,将外骨骼人机系统简化为一个二维线性倒立摆模型,通过公式(5)计算倒立摆模型在运动过程种的势能;After calculating the center of mass position of the human-machine system through the above steps, the exoskeleton human-machine system is simplified into a two-dimensional linear inverted pendulum model, and the potential energy of the inverted pendulum model during the motion is calculated through formula (5);
其中,x和分别表示质心在水平方向上的位置和速度信息,zc表示质心的高度,g表示重力加速度常数;Among them, x and represent the position and velocity information of the center of mass in the horizontal direction respectively, z c represents the height of the center of mass, and g represents the gravitational acceleration constant;
轨道能量用来表示质心的运动状态,在倒立摆的单次摆动过程中,轨道能量保持为一个恒定值,直到下一次切换倒立摆的支撑腿,轨道能量将被重新计算;人机系统运动时当前状态的轨道能量Ecurrent通过公式(5)来计算;不同的轨道能量得到不同的水平地面上的下一步落脚点(捕获点),因此在这里有两种情况,当Ecurrent>0时,表示完成下一次支撑腿的切换以后,倒立摆模型还能继续向前运动;当Ecurrent<0时,表示倒立摆模型没有足够的能量来越过势能最高点而继续前进,在达到势能最高点前速度降为零并开始向后运动;因此人机系统的运动状态可以根据轨道能量来判断;Orbital energy is used to represent the motion state of the center of mass. During a single swing of the inverted pendulum, the orbital energy remains at a constant value until the next time the supporting legs of the inverted pendulum are switched, and the orbital energy will be recalculated; when the human-machine system moves The orbital energy E current of the current state is calculated by formula (5); different orbital energies result in different next landing points (capture points) on the horizontal ground, so there are two situations here. When E current > 0, It means that after completing the next switching of the supporting legs, the inverted pendulum model can continue to move forward; when E current <0, it means that the inverted pendulum model does not have enough energy to cross the highest point of potential energy and continue to move forward. Before reaching the highest point of potential energy, The speed drops to zero and begins to move backward; therefore, the motion state of the human-machine system can be judged based on the orbital energy;
坡度估计器用于实时估计当前外骨骼人机系统所处坡道的坡度,是基于外骨骼本身的传感数据和几何尺寸信息来构建的;位于外骨骼背包中的IMU传感器可以实时感知整个躯干的姿态信息,位于髋、膝、踝关节中的角度传感器可以实时感知各个关节的角度信息;The slope estimator is used to estimate the slope of the slope where the current exoskeleton human-machine system is located in real time. It is built based on the sensing data and geometric size information of the exoskeleton itself; the IMU sensor located in the exoskeleton backpack can sense the slope of the entire torso in real time. Posture information, angle sensors located in the hip, knee, and ankle joints can sense the angle information of each joint in real time;
由于在正常的步行过程中,人的双腿是交替向前迈步的,当其中一条腿作为支撑腿的时候,另一条腿就作为摆动腿。在这里,假设支撑腿的脚底始终是与坡面贴合且不发生相对滑动的,因此坡度估计器是基于支撑腿的髋、膝、踝的关节角度和躯干的姿态信息对坡度进行计算的,并且左右两腿交替进行支撑;如图1所示,外骨骼人机系统在坡道上步行的时候根据支撑腿和摆动腿所处的步态相位不同分为(a)、(b)、(c)、(d)四种情况,其中:(a)表示在上坡过程中,摆动腿刚好离地的时刻;(b)表示在上坡过程中,摆动腿即将触地的时刻;(c)表示在下坡过程中,摆动腿刚好离地的时刻;(d)表示在下坡过程中,摆动腿即将触地的时刻;结合这四种情况得到在上坡和下坡的步行过程中,当其中一条腿作为支撑腿而另一条腿作为摆动腿在空中迈步向前运动时的所有关节角度和躯干的姿态信息,基于这些信息和外骨骼人机系统的几何尺寸信息来计算当前坡道的坡度;假设θ代表坡道的坡度,并且定义θ角与外骨骼的关节角度处于类似的坐标系统,也遵循右手定则的,也就是说,在上坡过程中θ<0,在下坡过程中θ>0,在水平地面上θ=0;其中α1、α2、α3、α4分别表示多边形A-B-C-E-F-A中,顶点A、B、C、E对应的内角,A点表示髋关节所在位置,B点表示膝关节所在位置,C点表示踝关节所在位置,E点表示小腿连杆CD的延长线与X轴的交点,F表示坐标系X-0-Y的坐标原点,有如下的几何关系:Since during normal walking, a person's legs step forward alternately, when one leg acts as a supporting leg, the other leg acts as a swinging leg. Here, it is assumed that the sole of the supporting leg is always in contact with the slope surface and does not slide relative to it. Therefore, the slope estimator calculates the slope based on the joint angles of the hip, knee, and ankle of the supporting leg and the posture information of the trunk. And the left and right legs alternately support each other; as shown in Figure 1, the exoskeleton human-machine system is divided into (a), (b), and (c) according to the different gait phases of the supporting leg and the swing leg when walking on the slope. ), (d) four situations, among which: (a) indicates the moment when the swing leg just leaves the ground during the uphill process; (b) indicates the moment when the swing leg is about to touch the ground during the uphill process; (c) Indicates the moment when the swing leg just leaves the ground during the downhill process; (d) indicates the moment when the swing leg is about to touch the ground during the downhill process; Combining these four situations, we get that during the uphill and downhill walking process, when All joint angles and posture information of the trunk when one leg is used as a supporting leg and the other leg is used as a swing leg and moves forward in the air, and the slope of the current ramp is calculated based on this information and the geometric size information of the exoskeleton human-machine system; Assume that θ represents the slope of the ramp, and the θ angle is defined to be in a similar coordinate system to the joint angle of the exoskeleton, which also follows the right-hand rule, that is, θ<0 during the uphill process, and θ> during the downhill process. 0, θ=0 on the horizontal ground; where α 1 , α 2 , α 3 , and α 4 respectively represent the interior angles corresponding to the vertices A, B, C, and E in the polygon ABCEFA. Point A represents the location of the hip joint, and point B Represents the position of the knee joint, point C represents the position of the ankle joint, point E represents the intersection of the extension line of the calf link CD and the X-axis, and F represents the coordinate origin of the coordinate system X-0-Y. There is the following geometric relationship:
基于平面几何关系,具有N条边的多边形内角之和为(N-2)·π,对于A-B-C-E-F-A组成的具有5条边的多变形来说,得到:Based on the plane geometric relationship, the sum of the interior angles of a polygon with N sides is (N-2)·π. For the multi-deformation with 5 sides composed of A-B-C-E-F-A, we get:
综合公式(6)得到四种情况下坡度θ的计算结果为:Based on formula (6), the calculation results of slope θ in four cases are:
基于躯干的位姿信息以及支撑腿的各个关节角度来计算坡道的坡度了;The slope of the ramp is calculated based on the posture information of the trunk and the joint angles of the supporting legs;
肌肉模型通过采集不同体型的健康志愿者进行康复训练时的肌电信号、关节角度等与肌肉力的对应关系,引入神经网络模型来构建个性化的关节力矩预测模型,为不同穿戴者使用下肢辅助机器人进行康复训练时个性化的肌力预测提供理论支持。其将肌肉抽象为一个由串联弹性单元(SE),主动收缩单元(CE)和并联弹性单元(PE)三个元素组成的肌肉结构力学模型,并以此反映肌肉收缩特性。肌肉模型如图2所示。肌肉模型如公式(9)所示:The muscle model collects the correspondence between the electromyographic signals, joint angles, etc. and muscle force of healthy volunteers of different body types during rehabilitation training, and introduces the neural network model to build a personalized joint torque prediction model to provide lower limb assistance for different wearers. Provide theoretical support for personalized muscle strength prediction when robots perform rehabilitation training. It abstracts the muscle into a muscle structural mechanics model composed of three elements: series elastic unit (SE), active contraction unit (CE) and parallel elastic unit (PE), and reflects the muscle contraction characteristics. The muscle model is shown in Figure 2. The muscle model is shown in formula (9):
LMT=LT+LM cos a. (9)L MT =L T +L M cos a. (9)
其中,LMT肌腱和肌纤维的总长度,LT为肌腱的长度,LM为肌纤维的总长度,α为羽状角即肌肉纤维束与肌腱的夹角;主动收缩单元和并联弹性单元通过羽状角α与串联弹性单元相连构成了肌肉系统;主动收缩单元在肌肉工作过程中为主动部分,并联和弹性单元则为被动收缩部分,肌纤维在主动收缩的过程中,通过拉伸依附在骨骼表面的肌腱,进而带动关节运动;肌纤维力为主动单元与被动单元的总和,即认为在任意时刻,肌纤维产生的力总大小为F,则:Among them, L MT is the total length of the tendon and muscle fiber, L T is the length of the tendon, L M is the total length of the muscle fiber, α is the pennation angle, which is the angle between the muscle fiber bundle and the tendon; the active contraction unit and the parallel elastic unit pass through the feather The shape angle α is connected with the series elastic unit to form a muscle system; the active contraction unit is the active part during the muscle work process, and the parallel and elastic units are the passive contraction part. During the active contraction process, the muscle fibers are attached to the bone surface through stretching. Tendons, thereby driving joint movement; muscle fiber force is the sum of active units and passive units, that is, it is considered that at any time, the total force generated by muscle fibers is F, then:
F=FCE+FPE, (10)F=F CE +F PE , (10)
式中,FCE主动收缩单元产生的力即主动力,FPE并联收缩单元产生的力即被动力;在肌肉模型中,FCE示肌肉横桥内部的化学反应所产生的力,可认为是肌肉纤维主动收缩产生的,其大小与肌肉激活程度、肌肉长度、肌肉收缩速率相关;FCE具体表达式为:In the formula, the force generated by the F CE active contraction unit is the active force, and the force generated by the F PE parallel contraction unit is the passive force; in the muscle model, F CE represents the force generated by the chemical reaction inside the muscle cross bridge, which can be considered as Produced by the active contraction of muscle fibers, its size is related to the degree of muscle activation, muscle length, and muscle contraction rate; the specific expression of F CE is:
FCE=a·F0·f(l)·f(v), (11)F CE =a·F 0 ·f(l)·f(v), (11)
式中,a为肌肉激活程度,与肌电信号的幅值有关。若某一时刻某块肌肉的激活程度为0,表示当前肌肉不存在主动肌力,则FCE=0。激活程度越高,表明参与运动收缩的肌纤维越多,当肌肉激活a=1时,认为目标肌肉中所有的肌纤维都参与运动,此时肌肉产生的张力达到最大值;F0为肌肉最大收缩力,其大小受肌肉生理形态的横截面积影响:In the formula, a is the degree of muscle activation, which is related to the amplitude of the electromyographic signal. If the activation degree of a certain muscle at a certain moment is 0, it means that there is no active muscle force in the current muscle, then F CE =0. The higher the degree of activation, the more muscle fibers are involved in exercise contraction. When muscle activation a=1, it is considered that all muscle fibers in the target muscle are involved in exercise. At this time, the tension generated by the muscle reaches the maximum value; F 0 is the maximum contraction force of the muscle. , its size is affected by the cross-sectional area of the muscle's physiological shape:
F0=K·PCSA, (12)F 0 =K·PCSA, (12)
式中,PCSA为肌肉的横截面积,K为肌肉所能提供的最大应力。而肌纤维长度和肌肉收缩速率均与运动关节的角度有关;In the formula, PCSA is the cross-sectional area of the muscle, and K is the maximum stress that the muscle can provide. The length of muscle fibers and the rate of muscle contraction are related to the angle of the moving joint;
FPE并联收缩单元产生的力即被动力,是由肌肉纤维发生弹性形变产生的。当肌肉纤维的长度超过一定范围时肌肉便会产生张力迫使肌肉纤维恢复原始状态,故FPE的大小主要受最大收缩力(F0)动力长度关系的影响:The force generated by the F PE parallel contraction unit is the passive force, which is generated by the elastic deformation of muscle fibers. When the length of the muscle fiber exceeds a certain range, the muscle will generate tension to force the muscle fiber to return to its original state. Therefore, the size of F PE is mainly affected by the maximum contraction force (F 0 ) dynamic length relationship:
FPE=F0·f(l). (13)F PE =F 0 ·f(l). (13)
在计算得到关节肌力后,通过与健康志愿者的肌力数据以及穿戴者的肌力数据进行比对,即可得到此时穿戴者的生理状态;在主动训练中,也可将其作为输出对穿戴者主动运动意图进行提取与识别。After calculating the joint muscle strength, by comparing it with the muscle strength data of healthy volunteers and the wearer's muscle strength data, the physiological state of the wearer at this time can be obtained; in active training, it can also be used as output Extract and identify the wearer's active movement intention.
进一步的,认知与决策模块中的计算方法的具体计算步骤为:Further, the specific calculation steps of the calculation method in the cognition and decision-making module are:
在根据感知和识别算法得到质心位置与坡道坡度后,利用计算得到的数据进行认知与决策方法的计算;After obtaining the centroid position and ramp slope based on the perception and recognition algorithm, the calculated data is used to calculate cognitive and decision-making methods;
为了维持平衡,通常情况下,机器人的轨道能量被设定为0,假设外骨骼机器人当前处于站立平衡的状态,如果外骨骼机器人受到了外界的干扰(例如有人从背后施加了一个推力),为了保持平衡,外骨骼机器人需要采取向前迈步的动作来恢复平衡,捕获点理论根据当前质心运动状态预测下一步的落脚点,通过控制外骨骼机器人的下一次迈步落脚位置来使外骨骼机器人维持步行过程中的稳定和平衡;In order to maintain balance, the orbital energy of the robot is usually set to 0. It is assumed that the exoskeleton robot is currently in a standing balance state. If the exoskeleton robot is disturbed by the outside world (for example, someone applies a push from behind), in order To maintain balance, the exoskeleton robot needs to take a forward step to restore balance. The capture point theory predicts the next foothold based on the current motion state of the center of mass. The exoskeleton robot maintains walking by controlling the foothold of the exoskeleton robot's next step. stability and balance in the process;
当环境为平地时,假设倒立摆模型交换支撑腿的过程是瞬间完成的,并且不损失能量,基于当前倒立摆模型的质心位置、质心速度和给定的轨道能量来计算下一步落脚点;假设切换支撑腿以后的倒立摆模型轨道能量为Edesired,则有:When the environment is flat, it is assumed that the process of exchanging supporting legs of the inverted pendulum model is completed instantaneously without losing energy. The next step is calculated based on the center of mass position, center of mass velocity and given orbital energy of the current inverted pendulum model; Assume The orbit energy of the inverted pendulum model after switching the supporting legs is E desired , then:
式中xt与分别表示下一次切换支撑腿时刻水平方向的质心位置与加速度,xcp表示在水平地面上的下一步落脚点(捕获点),zc表示质心的高度;where x t and Respectively represent the position and acceleration of the center of mass in the horizontal direction at the next time the support leg is switched, x cp represents the next foothold (capture point) on the horizontal ground, and z c represents the height of the center of mass;
因此,给定期望的轨道能量Edesired,则轨道能量自适应捕获点xcp计算为:Therefore, given the desired orbital energy E desired , the orbital energy adaptive capture point x cp is calculated as:
其中,sign()函数为符号函数,当时返回值为1,其他情况返回值为-1;支撑腿的切换时间应该是一个经过试验的经验值,所选择的切换时间要保证上面的式子才有意义,否则就不能在下一次迈步的时候使轨道能量达到所期望的Edesired,需要多次迈步;给定一个期望的轨道能量Edesired,通过当前的质心运动状态来计算每一步的落脚点,而且就算在这个过程中外骨骼人机系统模型受到来自拐杖等外界力的干扰,最后也是影响到当前这一步中质心的运动状态,在计算下一步落脚点的时候是会根据新的运动状态来计算;Among them, the sign() function is a sign function, when The return value is 1, otherwise the return value is -1; the switching time of the supporting leg should be a tested experience value, and the selected switching time must ensure The above formula is meaningful, otherwise the orbital energy cannot reach the desired Edesired in the next step, and multiple steps are needed; given a desired orbital energy Edesired , each step is calculated through the current motion state of the center of mass. The foothold of one step, and even if the exoskeleton human-machine system model is interfered by external forces such as crutches during this process, it will ultimately affect the motion state of the center of mass in the current step. When calculating the foothold of the next step, it will be based on the new Calculate the motion state;
当环境存在坡道时,线性倒立摆模型的高度是可变的,且与坡度有关;二维线性倒立摆在坡道上的运动过程中,质心的高度是沿着一条直线运动的,这条直线的斜率与坡道的坡度有关。直线的方程为:When there is a slope in the environment, the height of the linear inverted pendulum model is variable and related to the slope; during the movement of the two-dimensional linear inverted pendulum on the slope, the height of the center of mass moves along a straight line. The slope of is related to the slope of the ramp. The equation of the straight line is:
z=z0+kx, (16)z=z 0 +kx, (16)
其中,斜率k=tanθ,θ为坡道的坡度,z0表示初始时刻的质心高度;值得注意的是,在上坡运动过程中,θ<0,因此k<0;在下坡运动过程中,θ>0,因此k>0;首先来看水平方向的运动,无论是在平地上还是在坡道上,线性倒立摆模型的水平运动过程是一致的,因此只要知道了倒立摆模型在初始时刻的质心运动状态,即可计算在后续任意时刻的质心运动状态,计算质心运动状态方式为:Among them, the slope k=tanθ, θ is the slope of the ramp, z 0 represents the height of the center of mass at the initial moment; it is worth noting that during the uphill movement, θ<0, so k<0; during the downhill movement, θ>0, so k>0; First, let’s look at the motion in the horizontal direction. Whether on flat ground or on a slope, the horizontal motion process of the linear inverted pendulum model is the same. Therefore, as long as we know the motion of the inverted pendulum model at the initial moment The motion state of the center of mass can be calculated as the motion state of the center of mass at any subsequent moment. The method for calculating the motion state of the center of mass is:
其中是一个常量,t表示时间,这样就可以计算在倒立摆的单个摆动周期中,任意时刻的质心水平运动状态了;另外在竖直方向上的运动通过质心沿着坡道运动的直线公式得到,计算方法如下:in is a constant, t represents time, so that the horizontal motion state of the center of mass at any moment in a single swing cycle of the inverted pendulum can be calculated; in addition, the motion in the vertical direction is obtained by the straight-line formula of the center of mass moving along the ramp, The calculation method is as follows:
zt=z0+k·Δx=z0+k·(xt-x0) (18)z t =z 0 +k·Δx=z 0 +k·(x t -x 0 ) (18)
其中,z0表示初始时刻质心的高度,Δx表示从初始时刻到支撑腿切换时刻质心的水平运动距离;那么,假设倒立摆模型在某一次的摆动过程中,其初始时刻的摆动腿脚的位置为P0:Among them, z 0 represents the height of the center of mass at the initial moment, and Δx represents the horizontal movement distance of the center of mass from the initial moment to the moment when the supporting leg switches; then, assuming that the inverted pendulum model is in a certain swing process, the position of the swinging legs at the initial moment is P0 :
则在t时刻切换支撑腿时,摆动腿的落脚点用公式(20)来计算:Then when the supporting leg is switched at time t, the foothold of the swing leg is calculated using formula (20):
已经得到了摆动脚的起始位置P0和下一步的落脚位置Pcp,根据这两个位置来规划一条从摆动脚的起始位置到落脚点的空间轨迹作为外骨骼机器人的步态轨迹。The starting position P 0 of the swinging foot and the next landing position P cp have been obtained. Based on these two positions, a spatial trajectory from the starting position of the swinging foot to the landing point is planned as the gait trajectory of the exoskeleton robot.
进一步的,规划与控制方法的具体计算步骤为:Further, the specific calculation steps of the planning and control method are:
在根据认知与决策算法得到外骨骼机器人摆动脚的起始位置与下一步的落脚位置后,就可以根据这两个落点的位置规划一条外骨骼机器人的步态轨迹。由于人的步态具有一定的运动规律,如果使用常规的插值方法随意规划一条轨迹,可能会导致步行的过程不符合步行规律,导致步行过程不舒适。因此,可以考虑从健康人的步态轨迹中学习步态的运动规律,并根据要求来生成新的步态轨迹。After obtaining the starting position and next landing position of the exoskeleton robot's swinging feet based on the cognitive and decision-making algorithm, a gait trajectory of the exoskeleton robot can be planned based on the positions of these two landing points. Since human gait has certain movement patterns, if conventional interpolation methods are used to randomly plan a trajectory, the walking process may not conform to the walking patterns, making the walking process uncomfortable. Therefore, it can be considered to learn the motion rules of gait from the gait trajectories of healthy people and generate new gait trajectories according to requirements.
本算法中采用了运动捕捉系统Vicon来采集正常人在平地上的步行轨迹作为步态模型的示教轨迹。基于动态运动基元的步态模型在学习到步态轨迹的运动规律后,可根据外骨骼人机系统模型实时预测的落脚点来规划不同的步态轨迹,从而适应不同坡度的坡道地形。建模下肢助行外骨骼机器人步态轨迹的基本模型为:In this algorithm, the motion capture system Vicon is used to collect the walking trajectory of normal people on flat ground as the teaching trajectory of the gait model. After learning the motion rules of the gait trajectory, the gait model based on dynamic motion primitives can plan different gait trajectories based on the footholds predicted in real time by the exoskeleton human-machine system model, thereby adapting to slope terrain of different slopes. The basic model for modeling the gait trajectory of a lower-limb walking exoskeleton robot is:
其中τ是一个常数,用于缩放时间量来调整轨迹的速度,αy、βy都是常数,y=[x z]T表示摆动脚的空间位置,表示其速度和加速度,ycp表示最终的期望落脚点;f为非线性项,如下所示:where τ is a constant, used to scale the amount of time to adjust the speed of the trajectory, α y , β y are both constants, y=[xz] T represents the spatial position of the swinging foot, represents its speed and acceleration, y cp represents the final expected foothold; f is a nonlinear term, as shown below:
N表示基函数的个数,v来自一个一阶系统,满足其中av是一个常数;基函数Ψi为径向基函数:N represents the number of basis functions, v comes from a first-order system, and satisfies where a v is a constant; the basis function Ψ i is the radial basis function:
其中,σi和ci分别表示基函数Ψi的宽度和中心值;假设示教轨迹表示为则得到需要学习的ftarget:Among them, σ i and c i respectively represent the width and center value of the basis function Ψ i ; assuming that the teaching trajectory is expressed as Then we get the f target that needs to be learned:
要确定每一个基函数Ψi对应的权重值wi,构造损失函数:To determine the weight value w i corresponding to each basis function Ψ i , construct a loss function:
其中,t表示时间步,T表示整条轨迹总的时间步数;求解上述损失函数的最小化过程即得到模型的参数,步态轨迹模型学习完成以后,给定不同的轨迹初始位置和末端位置来生成不同的步态轨迹。Among them, t represents the time step, and T represents the total number of time steps of the entire trajectory; the minimization process of solving the above loss function is to obtain the parameters of the model. After the gait trajectory model learning is completed, different initial positions and end positions of the trajectory are given. to generate different gait trajectories.
综合前面两个算法计算得到的数据,可以通过外骨骼人机系统模型来预测在不同坡度的坡道上的每一步落脚点,在根据已知的每一步的起点位置和落脚点位置,结合基于DMP的步态轨迹模型就可以生成从每一步起点位置到下一步落脚点位置的步态轨迹与后续的运动序列了。Combining the data calculated by the previous two algorithms, the exoskeleton human-machine system model can be used to predict the foothold of each step on the slopes of different slopes. Based on the known starting point and foothold of each step, combined with the DMP-based The gait trajectory model can generate the gait trajectory and subsequent motion sequence from the starting point of each step to the foothold of the next step.
相比于传统的机器人仿真系统,本发明提供的仿真系统具有以下优势:Compared with traditional robot simulation systems, the simulation system provided by the present invention has the following advantages:
1.现实世界与仿真环境之间的外骨骼人机系统状态的同步性更好,可充分对外骨骼物理人机系统进行数字复刻,而非简单在将外骨骼人机系统和仿真平台之间进行数据传输;1. The state of the exoskeleton human-machine system between the real world and the simulation environment is better synchronized, and the physical human-machine system of the exoskeleton can be fully digitally reproduced, rather than simply between the exoskeleton human-machine system and the simulation platform. carry out data transmission;
2.算法仿真的丰富度更高,基于上述数字复刻的外骨骼人机系统模型,该仿真系统可利用云服务器的计算力进行并行仿真,可同步仿真多种算法并进行对比分析;2. The algorithm simulation is richer. Based on the above-mentioned digitally reproduced exoskeleton human-machine system model, the simulation system can use the computing power of the cloud server to perform parallel simulations, and can simultaneously simulate multiple algorithms and perform comparative analysis;
3.仿真平台的可视化程度更高,与传统仿真系统只能简易展示仿真过程中的数据曲线不同,本发明提供的仿真平台可同步复现外骨骼人机系统的运动状态信息并在仿真模型上进行展示,此外,本发明提供的多算法并行仿真过程与仿真回放功能也能提供更加丰富的仿真过程可视化结果。3. The simulation platform has a higher degree of visualization. Unlike traditional simulation systems that can only simply display the data curves during the simulation process, the simulation platform provided by the present invention can synchronously reproduce the motion status information of the exoskeleton human-machine system and display it on the simulation model. display. In addition, the multi-algorithm parallel simulation process and simulation playback function provided by the present invention can also provide richer simulation process visualization results.
附图说明Description of the drawings
图1为外骨骼人机系统在坡道上的四种情况示意图;Figure 1 is a schematic diagram of the four situations of the exoskeleton human-machine system on the ramp;
图2为Hill理论模型示意图;Figure 2 is a schematic diagram of Hill’s theoretical model;
图3为物理人机双向交互仿真系统的架构示意图;Figure 3 is a schematic diagram of the architecture of the physical human-machine two-way interactive simulation system;
图4为外骨机器人的传感系统示意图;Figure 4 is a schematic diagram of the sensing system of the exoskeleton robot;
图5为穿戴者数据采集系统示意图;Figure 5 is a schematic diagram of the wearer data collection system;
图6为环境数据采集系统示意图;Figure 6 is a schematic diagram of the environmental data collection system;
图7为数据采集模块示意图;Figure 7 is a schematic diagram of the data acquisition module;
图8为仿真同步模块示意图;Figure 8 is a schematic diagram of the simulation synchronization module;
图9为智能算法模块示意图;Figure 9 is a schematic diagram of the intelligent algorithm module;
图10为仿真可视化模块示意图。Figure 10 is a schematic diagram of the simulation visualization module.
实施方式Implementation
本发明公开了一种外骨骼机器人的物理人机双向交互仿真系统,包括外骨骼人机系统、数据传输模块、仿真同步模块、智能算法模块、仿真可视化模块。如图3所示。The invention discloses a physical human-machine two-way interactive simulation system of an exoskeleton robot, which includes an exoskeleton human-machine system, a data transmission module, a simulation synchronization module, an intelligent algorithm module, and a simulation visualization module. As shown in Figure 3.
本发明是对传统机器人仿真系统的一个扩展和改进,需要依赖现有的操作系统。例如外骨骼人机系统的主控软件可基于嵌入式Linux操作系统构建,仿真系统的智能算法模块可基于Linux、Unix、Windows的服务器/云服务器操作系统构建,仿真系统的可视化模块可基于Linux、Windows、MacOS等桌面操作系统构建。The present invention is an expansion and improvement of the traditional robot simulation system and needs to rely on the existing operating system. For example, the main control software of the exoskeleton human-machine system can be built based on the embedded Linux operating system, the intelligent algorithm module of the simulation system can be built based on the server/cloud server operating system of Linux, Unix, and Windows, and the visualization module of the simulation system can be built based on Linux, Unix, and Windows server/cloud server operating systems. Construction of desktop operating systems such as Windows and MacOS.
本发明的使用对象为外骨骼机器人系统及基于个人笔记本电脑/台式电脑/服务器的仿真系统,各模块之间需要通过相应的通信协议进行数据交换。在外骨骼机器人系统上,外骨骼主控模块与系统的其他各部分子模块之间通过CAN、SPI、I2C、串口、Ethernet等通信协议来完成数据传输;外骨骼机器人系统与仿真系统中的智能算法模块和可视化模块之间可通过基于Ethernet的高级通信协议来完成,例如TCP/IP、Socket等,也可以在Ethernet基础之上自建通信协议。The application objects of the present invention are exoskeleton robot systems and simulation systems based on personal laptops/desktop computers/servers, and each module needs to exchange data through corresponding communication protocols. On the exoskeleton robot system, data transmission is completed between the exoskeleton main control module and other sub-modules of the system through CAN, SPI, I2C, serial port, Ethernet and other communication protocols; the intelligent algorithm module in the exoskeleton robot system and simulation system The communication with the visualization module can be accomplished through advanced communication protocols based on Ethernet, such as TCP/IP, Socket, etc. You can also build your own communication protocol based on Ethernet.
外骨骼人机系统:这部分主要由真实世界中实际的外骨骼机器人和穿戴者构成,外骨骼机器人可与穿戴者和真实的物理环境进行交互,实时产生各种传感和交互数据,主要包括三大类:外骨骼数据、穿戴者数据和环境数据。其中,外骨骼数据包括外骨骼人机系统的运动姿态、关节角度、人机交互力、脚底压力等信息(如图4所示);穿戴者数据包括穿戴者自身的肌电/脑电等生理信号数据(如图5所示);环境数据包括基于姿态传感和视觉传感(深度相机、点云相机等设备)获取的地形数据、周围障碍物数据(如图6所示)。Exoskeleton human-machine system: This part is mainly composed of the actual exoskeleton robot and the wearer in the real world. The exoskeleton robot can interact with the wearer and the real physical environment, and generate various sensing and interaction data in real time, mainly including Three major categories: exoskeleton data, wearer data, and environmental data. Among them, the exoskeleton data includes the movement posture, joint angles, human-computer interaction force, sole pressure and other information of the exoskeleton human-machine system (as shown in Figure 4); the wearer data includes the wearer's own physiological functions such as myoelectricity/encephalography. Signal data (as shown in Figure 5); environmental data includes terrain data and surrounding obstacle data obtained based on attitude sensing and visual sensing (depth cameras, point cloud cameras and other devices) (as shown in Figure 6).
数据采集模块:如图7所示,该模块可实时采集前述外骨骼人机系统的各种数据(图4、图5、图6),包括外骨骼数据、穿戴者数据和环境数据。这些数据通过数模转换接口(AD转换模块)转换为数字信号以后,根据其传感器模块所采用的总线协议的不同可通过CAN总线、串口总线、SPI总线、I2C总线以及Ethernet等将传感数据传输到数据采集模块中,数据采集模块再将所有的传感数据打包为统一的格式并通过仿真同步模块实时回传至仿真系统。数据采集模块的姿态数据主要来自基于IMU的姿态传感系统,在外骨骼机器人系统中用于姿态采集的模块需要在穿戴者的头部、躯干、双臂位置安装多个基于IMU的姿态传感器,同时还需要在骨骼机器人的躯干、大腿、小腿、脚部等部位安装基于IMU的姿态传感器,用于全方位的采集外骨骼人机系统的姿态信息。姿态数据可通过仿真同步模块传输到仿真环境中,用于外骨骼人机系统的运动状态重构和实时可视化。Data collection module: As shown in Figure 7, this module can collect various data of the aforementioned exoskeleton human-machine system in real time (Figure 4, Figure 5, Figure 6), including exoskeleton data, wearer data and environmental data. After these data are converted into digital signals through the digital-to-analog conversion interface (AD conversion module), the sensing data can be transmitted through CAN bus, serial port bus, SPI bus, I2C bus and Ethernet according to the bus protocol used by the sensor module. In the data acquisition module, the data acquisition module then packages all the sensor data into a unified format and transmits it back to the simulation system in real time through the simulation synchronization module. The posture data of the data acquisition module mainly comes from the IMU-based posture sensing system. The module for posture collection in the exoskeleton robot system requires multiple IMU-based posture sensors to be installed on the wearer's head, torso, and arms. At the same time It is also necessary to install IMU-based attitude sensors on the torso, thighs, calves, feet and other parts of the skeletal robot to collect all-round attitude information of the exoskeleton human-machine system. The posture data can be transmitted to the simulation environment through the simulation synchronization module and used for motion state reconstruction and real-time visualization of the exoskeleton human-machine system.
数据采集模块中的交互力数据主要来自安装于外骨骼大腿、小图、脚踝、脚底等位置的3轴/6轴交互力传感器,一般安装于外骨骼机器人与穿戴者接触的部分,与绑缚链接到一起,用于采集在整个运动过程中外骨骼机器人和穿戴者之间的交互力以及外骨骼人机系统与地面的接触力等。原始的交互力数据一般是模拟信号,还需要通过模数转换接口(AD)将模拟信号转换为数字信号,再通过相应的数据传输总线(CAN、SPI、I2C、串口等)将数据传输到外骨骼人机系统的主控部分,然后通过仿真同步模块传输到仿真环境中。The interactive force data in the data acquisition module mainly comes from 3-axis/6-axis interactive force sensors installed at the thighs, thumbnails, ankles, soles, etc. of the exoskeleton. They are generally installed at the parts where the exoskeleton robot comes into contact with the wearer and are tied to the exoskeleton. Linked together, they are used to collect the interaction force between the exoskeleton robot and the wearer during the entire movement, as well as the contact force between the exoskeleton human-machine system and the ground. The original interaction force data is generally an analog signal, which also needs to be converted into a digital signal through an analog-to-digital conversion interface (AD), and then the data is transmitted to the outside through the corresponding data transmission bus (CAN, SPI, I2C, serial port, etc.) The main control part of the skeletal human-machine system is then transmitted to the simulation environment through the simulation synchronization module.
数据采集模块中的穿戴者数据主要是通过肌电(EMG)和脑电(EEG)采集设备实时采集穿戴者的生理信号,经过简单的滤波处理以后通过仿真同步模块传输到仿真环境中进行可视化和用于智能算法的感知识别模块,可用于表征穿戴者当前的运动状态、生理状态等基本信息。此外,这些信息还可用于穿戴者运动意图的感知识别和分类,用于运动模式的触发、运动趋势的预测等。The wearer's data in the data acquisition module mainly collects the wearer's physiological signals in real time through electromyography (EMG) and electroencephalography (EEG) acquisition equipment. After simple filtering, it is transmitted to the simulation environment through the simulation synchronization module for visualization and processing. The perception recognition module used in intelligent algorithms can be used to characterize the wearer's current motion status, physiological status and other basic information. In addition, this information can also be used to perceive and classify the wearer's movement intentions, trigger movement patterns, predict movement trends, etc.
数据采集模块中的环境数据采集一般是通过安装于外骨骼人机系统躯干位置的前、侧和后方的视觉传感系统来完成,包括深度相机、RGB相机、激光雷达、点云相机等设备,实时采集外骨骼人机系统周围的环境信息,并通过与视觉传感设备相连的姿态传感器实时采集当前视觉传感的姿态信息,用以识别和校正当前的视觉传感数据。视觉传感数据及对应的姿态数据在同步打包以后传输到仿真环境中用于地形环境的重构和可视化。此外,视觉传感数据还需要同步到仿真可视化模块中并实时展示,用于以第一视角观察外骨骼人机系统当前面对的环境。Environmental data collection in the data collection module is generally completed through visual sensing systems installed on the front, side and rear of the torso of the exoskeleton human-machine system, including depth cameras, RGB cameras, lidar, point cloud cameras and other equipment. The environmental information around the exoskeleton human-machine system is collected in real time, and the current visual sensing posture information is collected in real time through the posture sensor connected to the visual sensing device to identify and correct the current visual sensing data. The visual sensing data and corresponding attitude data are synchronously packaged and transmitted to the simulation environment for reconstruction and visualization of the terrain environment. In addition, the visual sensing data needs to be synchronized to the simulation visualization module and displayed in real time to observe the environment currently faced by the exoskeleton human-machine system from a first-person perspective.
仿真同步模块:如图8所示,该模块的主要作用是在真实环境中的外骨骼人机系统和在虚拟环境中的仿真模型之前建立数据交换的通道,通过基于Ethernet的网络通信协议建立仿真环境与物理人机系统之间的通信协议并在两者之间进行数据传输。该模块应具有高度实时的通信速率,可将前述外骨骼人机系统的各类传感数据和运动状态数据实时传输到仿真环境中,以便于在仿真环境“复刻”现实世界中的外骨骼人机模型及其周边的环境信息,为后续的算法模块构造基于真实数据的仿真环境。此外,该仿真同步模块还能将算法模块生成的控制指令及仿真环境中的外骨骼人机系统状态信息同步发送给真实环境中的外骨骼人机系统,以达到真实环境和虚拟环境的双向交互与同步。与传统仿真环境不同的是,基于该仿真同步模块,真实世界中的外骨骼人机系统模型可与虚拟环境中的外骨骼人机系统仿真模型同步状态信息,以达到对真实世界中的外骨骼人机模型的数字化,便于进一步的控制和仿真结果分析;仿真同步模块的主要作用是基于Ethernet来构建相应的通信协议,用于在真实世界的外骨骼人机系统与仿真环境中的外骨骼人机仿真模型之间进行高速的数据交换,将真实世界的数据传输到仿真环境,同时将仿真环境中产生的部分数据同步到真实世界的外骨骼人机系统。除此之外,还可通过构建相应的同步机制来保证真实世界的外骨骼人机系统与仿真环境中的外骨骼人机系统在运动状态上保持高度的同步性。Simulation synchronization module: As shown in Figure 8, the main function of this module is to establish a data exchange channel between the exoskeleton human-machine system in the real environment and the simulation model in the virtual environment, and establish simulation through the Ethernet-based network communication protocol Communication protocol between the environment and the physical human-machine system and transfer data between the two. This module should have a high real-time communication rate and can transmit various sensing data and motion status data of the aforementioned exoskeleton human-machine system to the simulation environment in real time, so that the exoskeleton in the real world can be "reproduced" in the simulation environment. The human-machine model and its surrounding environmental information construct a simulation environment based on real data for subsequent algorithm modules. In addition, the simulation synchronization module can also synchronously send the control instructions generated by the algorithm module and the status information of the exoskeleton human-machine system in the simulation environment to the exoskeleton human-machine system in the real environment to achieve two-way interaction between the real environment and the virtual environment. And synchronization. Different from the traditional simulation environment, based on this simulation synchronization module, the exoskeleton human-machine system model in the real world can synchronize status information with the exoskeleton human-machine system simulation model in the virtual environment to achieve the best understanding of the exoskeleton in the real world. The digitization of the human-machine model facilitates further control and analysis of simulation results; the main function of the simulation synchronization module is to build the corresponding communication protocol based on Ethernet, which is used in the real-world exoskeleton human-machine system and the exoskeleton human in the simulation environment. Perform high-speed data exchange between machine simulation models, transmit real-world data to the simulation environment, and synchronize some data generated in the simulation environment to the real-world exoskeleton human-machine system. In addition, corresponding synchronization mechanisms can also be constructed to ensure that the exoskeleton human-machine system in the real world and the exoskeleton human-machine system in the simulation environment maintain a high degree of synchronization in motion.
智能算法模块:如图9所示,该模块是仿真系统的核心模块,其主要作用是基于前述外骨骼人机系统同步到仿真环境中的各类数据构造的仿真环境进行外骨骼人机系统的感知识别、认知决策和控制规划算法仿真。其中,感知与识别算法主要是综合分析采集到的外骨骼机器人传感数据、穿戴者数据以及环境数据,并针对其中的关键信息进行识别和分析,例如穿戴者生理状态及运动意图、运动状态及稳定性、地形环境及尺寸参数等;认知与决策算法主要是根据感知和识别算法的结果针对特定的运动目标充分分析人机运动状态数据,并根据人体运动意图和目标运动状态对外骨骼人机系统在复杂环境中的后续运动趋势、行进路线、通过特定地形、达到特定前进速度等做出决策和仿真优化,并给出相应的预测结果;规划与控制算法主要是根据认知和决策算法给出的预测结果和目标运动状态与当前的外骨骼人机状态信息建立相关优化算法,以产生后续的运动规划序列,并实时生成控制指令。通过上述上个子模块的有序配合,智能算法模块可引入多种智能算法参与其中的感知识别、认知决策和规划控制阶段,从而得到不同的仿真结果。此外,该模块生成的控制指令还将通过仿真同步模块与真实世界的外骨骼人机系统建立通信,并实时控制外骨骼人机系统按照规划结果运行,以使仿真环境中的外骨骼人机模型与真实世界中的外骨骼人机系统达到高度的同步性。仿真过程的可视化界面可运行于个人笔记本电脑/台式电脑/服务器上,可基于QT、MFC等软件界面开发架构进行可视化界面的开发。仿真可视化界面支持自定义仿真环境的数学模型或者开源物理仿真引擎(ODE、Bullet、Mujoco等),使用这些物理引擎对仿真模型及其环境进行构建,并计算其中的运动学、动力学运动过程,包括仿真环境中各连杆和关节的位置、速度、加速、力,以及碰撞过程、摩擦过程、软体结构的形变过程等。Intelligent algorithm module: As shown in Figure 9, this module is the core module of the simulation system. Its main function is to conduct simulation of the exoskeleton human-machine system based on the simulation environment constructed by synchronizing the aforementioned exoskeleton human-machine system to various data in the simulation environment. Perception recognition, cognitive decision-making and control planning algorithm simulation. Among them, the perception and recognition algorithm mainly comprehensively analyzes the collected exoskeleton robot sensing data, wearer data and environmental data, and identifies and analyzes the key information, such as the wearer's physiological state and movement intention, movement status and Stability, terrain environment and size parameters, etc.; the cognitive and decision-making algorithm is mainly based on the results of the perception and recognition algorithm to fully analyze the human-machine motion status data for specific moving targets, and evaluate the exoskeleton human-machine based on the human movement intention and target motion status. Decisions and simulation optimization are made based on the system's subsequent movement trends, travel routes, passing through specific terrain, reaching specific forward speeds, etc. in complex environments, and corresponding prediction results are given; planning and control algorithms are mainly based on cognitive and decision-making algorithms. The prediction results and target motion status are combined with the current exoskeleton human-machine status information to establish a related optimization algorithm to generate subsequent motion planning sequences and generate control instructions in real time. Through the orderly cooperation of the above sub-modules, the intelligent algorithm module can introduce a variety of intelligent algorithms to participate in the perception identification, cognitive decision-making and planning control stages, thereby obtaining different simulation results. In addition, the control instructions generated by this module will also establish communication with the real-world exoskeleton human-machine system through the simulation synchronization module, and control the exoskeleton human-machine system in real time to operate according to the planning results, so that the exoskeleton human-machine model in the simulation environment Achieve a high degree of synchronization with the exoskeleton human-machine system in the real world. The visual interface of the simulation process can be run on a personal laptop/desktop computer/server, and the visual interface can be developed based on software interface development architectures such as QT and MFC. The simulation visualization interface supports mathematical models of customized simulation environments or open source physics simulation engines (ODE, Bullet, Mujoco, etc.). These physics engines are used to build simulation models and their environments, and calculate the kinematics and dynamic motion processes in them. Including the position, speed, acceleration, force of each link and joint in the simulation environment, as well as the collision process, friction process, deformation process of the soft body structure, etc.
智能算法模块可根据计算需求布置于个人笔记本电脑、台式机或者服务器上,或采用分布式的多点布置方法,中间采用基于Ethernet的网络协议进行互联互通,以充分利用服务器的高运算能力和个人电脑的移动灵活性,并通过仿真可视化模块中的仿真控制模块进行协调控制。Intelligent algorithm modules can be deployed on personal laptops, desktops or servers according to computing needs, or use a distributed multi-point deployment method, with Ethernet-based network protocols used for interconnection in the middle to make full use of the high computing power of the server and personal The mobile flexibility of the computer is coordinated and controlled through the simulation control module in the simulation visualization module.
智能算法模块中,感知与识别算法可采用常规的模式识别与机器学习算法针对采集得到的各类数据进行分析和识别,提取关键特征信息,提升识别效率等;认知与决策算法可结合穿戴者的脑电和肌电信号对穿戴者的运动意图进行提取和识别,并结合前述环境信息的感知与识别算法构建人机共融的协同认知与决策算法,以提升整个算法的智能化程度,同时还可实现人在环路的人机协同决策策略;规划和控制算法可采用机器人领域的常见建模、控制与规划算法,也可结合模仿学习、强化学习等新兴机器人领域的规划控制算法针对在仿真环境中重构出来的人机仿真模型和环境模型进行交互式学习,构建优化目标,以探索最优的规划和控制策略。In the intelligent algorithm module, the perception and recognition algorithms can use conventional pattern recognition and machine learning algorithms to analyze and identify various types of data collected, extract key feature information, improve recognition efficiency, etc.; the cognition and decision-making algorithms can be combined with the wearer's The EEG and EMG signals are used to extract and identify the wearer's movement intention, and are combined with the aforementioned environmental information perception and recognition algorithms to build a collaborative cognitive and decision-making algorithm that integrates humans and machines to improve the intelligence of the entire algorithm. At the same time, it can also realize the human-machine collaborative decision-making strategy of human-in-the-loop; planning and control algorithms can adopt common modeling, control and planning algorithms in the field of robots, or can also be combined with planning control algorithms in emerging robot fields such as imitation learning and reinforcement learning. The human-machine simulation model and environmental model reconstructed in the simulation environment are interactively learned to construct optimization goals to explore optimal planning and control strategies.
仿真可视化模块:如图10所示,该模块的主要作用是对整个仿真系统中产生的数据进行同步可视化,以便于研发人员能够直观地观察现有智能算法在当前外骨骼人机系统上实施的效果。该模块可分为几个子模块:人机状态显示与交互模块、数据显示模块、仿真过程控制模块、模型同步与可视化模块。其中,人机状态显示与交互模块主要是对仿真环境与真实的外骨骼人机系统之间的通信过程进行显示,包括连接状态、数据传输速度、实际的外骨骼人机运行状态等进行显示,并设计相应的交互控件以便于研发人员操作仿真环境与真实外骨骼人机系统之间的通断和启停过程;数据显示模块主要是用于显示真实外骨骼人机系统和仿真模型在运行过程中的各类数据,包括姿态信息、运动信息、交互力等数据以数据图表和曲线的形式进行展示,便于直观的分析数据;仿真过程控制模块主要是用于控制仿真模型在仿真环境中的运行过程,包括各类智能算法的切换使用、仿真过程的启停与调试等;模型同步与可视化模块主要是用于对真实外骨骼人机系统及其所处的环境在仿真环境中的数字重构过程进行可视化,并将重构出来的外骨骼人机仿真模型、地形环境等与真实世界中的外骨骼人机系统及其环境进行同步显示,同时还将以第一视角的方式展示当前外骨骼人机系统前方的地形环境、障碍物信息、行进路线等多种信息,方便研发人员对整个算法的设计和仿真过程进行深度调试,提升算法的有效性、可行性和稳定性。Simulation visualization module: As shown in Figure 10, the main function of this module is to synchronously visualize the data generated in the entire simulation system, so that developers can intuitively observe the performance of existing intelligent algorithms implemented on the current exoskeleton human-machine system. Effect. This module can be divided into several sub-modules: human-machine status display and interaction module, data display module, simulation process control module, model synchronization and visualization module. Among them, the human-machine status display and interaction module mainly displays the communication process between the simulation environment and the real exoskeleton human-machine system, including display of connection status, data transmission speed, actual exoskeleton human-machine operating status, etc. And design corresponding interactive controls to facilitate the R&D personnel to operate the on-off and start-stop processes between the simulation environment and the real exoskeleton human-machine system; the data display module is mainly used to display the running process of the real exoskeleton human-machine system and simulation model Various types of data in the system, including posture information, motion information, interaction force and other data, are displayed in the form of data charts and curves to facilitate intuitive analysis of data; the simulation process control module is mainly used to control the operation of the simulation model in the simulation environment. process, including switching and using various intelligent algorithms, starting, stopping and debugging the simulation process, etc.; the model synchronization and visualization module is mainly used for the digital reconstruction of the real exoskeleton human-machine system and its environment in the simulation environment The process is visualized, and the reconstructed exoskeleton human-machine simulation model, terrain environment, etc. are displayed simultaneously with the exoskeleton human-machine system and its environment in the real world. It also displays the current exoskeleton from a first-person perspective. Various information such as the terrain environment, obstacle information, and travel routes in front of the human-machine system facilitates R&D personnel to conduct in-depth debugging of the entire algorithm design and simulation process, improving the effectiveness, feasibility, and stability of the algorithm.
仿真可视化过程中的外骨骼人机仿真模型可通过Solidworks、AutoCAD等机械设计软件进行前期结构设计,保证与外骨骼真机模型在尺寸、质量、惯性等方面达到一致,然后可通过插件导出为URDF/SDF/XML等结构化的机器人描述文件,并导入到仿真平台构建相应的外骨骼机器人模型。机器人的尺寸调节部分可根据当前真实的外骨骼机器人模型进行一比一调整,以保证仿真环境中外骨骼机器人模型与真实世界中的外骨骼机器人模型在外观和尺寸上达到一致。The exoskeleton human-machine simulation model during the simulation visualization process can be used for preliminary structural design through mechanical design software such as Solidworks and AutoCAD to ensure that it is consistent with the exoskeleton real machine model in terms of size, mass, inertia, etc., and can then be exported as URDF through plug-ins. /SDF/XML and other structured robot description files, and import them into the simulation platform to build the corresponding exoskeleton robot model. The size adjustment part of the robot can be adjusted one-to-one according to the current real exoskeleton robot model to ensure that the exoskeleton robot model in the simulation environment is consistent in appearance and size with the exoskeleton robot model in the real world.
仿真可视化过程中的穿戴者可使用Solidworks、AutoCAD等机械设计软件进行前期结构设计,以还原基本的穿戴者人体模型,并提供尺寸调整接口,以便于后期对不同身体尺寸的穿戴者在仿真环境中重构。Wearers during the simulation visualization process can use mechanical design software such as Solidworks and AutoCAD for early structural design to restore the basic wearer human body model and provide a size adjustment interface to facilitate the later use of wearers with different body sizes in the simulation environment. Refactor.
仿真可视化过程中的地形环境可基于真实世界中的外骨骼人机系统通过视觉传感采集得到的环境信息和所使用的物理引擎在仿真环境中对地形环境进行重构,并做到与真实环境在尺寸上一比一的还原,从而可以在仿真环境中对外骨骼人机系统所面临的环境进行数字化复刻。The terrain environment in the simulation visualization process can be reconstructed in the simulation environment based on the environmental information collected through visual sensing by the exoskeleton human-machine system in the real world and the physics engine used, and be consistent with the real environment. The size is restored one to one, so that the environment faced by the exoskeleton human-machine system can be digitally reproduced in the simulation environment.
仿真可视化过程中,外骨骼机器人和穿戴者的运动过程可根据数据采集模块得到的真实世界中外骨骼机器人的运动状态、穿戴者的运动状态等信息,使用前述开源物理引擎进行动力学建模和仿真,并生成相应的控制指令控制仿真模型进行运动。During the simulation visualization process, the movement process of the exoskeleton robot and the wearer can be based on the information such as the movement status of the exoskeleton robot and the movement status of the wearer in the real world obtained by the data collection module, and the aforementioned open source physics engine can be used for dynamic modeling and simulation. , and generate corresponding control instructions to control the simulation model to move.
仿真可视化模块中,真实外骨骼机器人的运动过程和仿真环境中外骨骼人机仿真模型的运动过程以及在此过程中的环境变化都将被实时记录和存储,在仿真过程结束以后可以随时调取历史记录并回放仿真的过程,并同步展示仿真过程中的各类数据。In the simulation visualization module, the movement process of the real exoskeleton robot and the movement process of the exoskeleton human-machine simulation model in the simulation environment, as well as the environmental changes during the process, will be recorded and stored in real time. After the simulation process is completed, the history can be retrieved at any time. Record and playback the simulation process, and simultaneously display various data during the simulation process.
Claims (4)
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202311671118.2A CN117697717A (en) | 2023-12-07 | 2023-12-07 | Exoskeleton physical man-machine two-way interaction simulation system |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202311671118.2A CN117697717A (en) | 2023-12-07 | 2023-12-07 | Exoskeleton physical man-machine two-way interaction simulation system |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN117697717A true CN117697717A (en) | 2024-03-15 |
Family
ID=90154489
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202311671118.2A Pending CN117697717A (en) | 2023-12-07 | 2023-12-07 | Exoskeleton physical man-machine two-way interaction simulation system |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN117697717A (en) |
Cited By (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN118003341A (en) * | 2024-04-09 | 2024-05-10 | 首都体育学院 | A method for calculating the torque of lower limb joints based on reinforcement learning agent |
| CN118802077A (en) * | 2024-09-12 | 2024-10-18 | 南京高商机电科技有限公司 | A data communication method, platform and medium for simulation system |
| CN119055492A (en) * | 2024-11-05 | 2024-12-03 | 南昌大学第二附属医院 | A hip, knee and ankle rehabilitation exoskeleton smart machine for stroke patients |
| CN119407752A (en) * | 2024-12-05 | 2025-02-11 | 电子科技大学 | A collaborative control method of an exoskeleton and a safety bracket with adaptive external thrust |
| CN119717576A (en) * | 2024-12-25 | 2025-03-28 | 南京理工大学 | Numerical simulation method of human body-balance board control system model |
| CN120461448A (en) * | 2025-07-14 | 2025-08-12 | 国网山西省电力公司太原供电公司 | A wearable exoskeleton human-machine collaborative real-time control method based on artificial intelligence |
-
2023
- 2023-12-07 CN CN202311671118.2A patent/CN117697717A/en active Pending
Cited By (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN118003341A (en) * | 2024-04-09 | 2024-05-10 | 首都体育学院 | A method for calculating the torque of lower limb joints based on reinforcement learning agent |
| CN118802077A (en) * | 2024-09-12 | 2024-10-18 | 南京高商机电科技有限公司 | A data communication method, platform and medium for simulation system |
| CN118802077B (en) * | 2024-09-12 | 2025-01-28 | 南京高商机电科技有限公司 | A data communication method, platform and medium for simulation system |
| CN119055492A (en) * | 2024-11-05 | 2024-12-03 | 南昌大学第二附属医院 | A hip, knee and ankle rehabilitation exoskeleton smart machine for stroke patients |
| CN119407752A (en) * | 2024-12-05 | 2025-02-11 | 电子科技大学 | A collaborative control method of an exoskeleton and a safety bracket with adaptive external thrust |
| CN119717576A (en) * | 2024-12-25 | 2025-03-28 | 南京理工大学 | Numerical simulation method of human body-balance board control system model |
| CN120461448A (en) * | 2025-07-14 | 2025-08-12 | 国网山西省电力公司太原供电公司 | A wearable exoskeleton human-machine collaborative real-time control method based on artificial intelligence |
| CN120461448B (en) * | 2025-07-14 | 2025-09-30 | 国网山西省电力公司太原供电公司 | Man-machine collaborative real-time control method for wearable exoskeleton based on artificial intelligence |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN117697717A (en) | Exoskeleton physical man-machine two-way interaction simulation system | |
| Alamdari et al. | A review of computational musculoskeletal analysis of human lower extremities | |
| Xiang et al. | Optimization‐based dynamic human walking prediction: One step formulation | |
| CN101579238B (en) | Human motion capture three dimensional playback system and method thereof | |
| CN111631731B (en) | Near-infrared brain function and touch force/motion information fusion assessment method and system | |
| CN107616898B (en) | Upper limb wearable rehabilitation robot based on daily actions and rehabilitation evaluation method | |
| CN104921851B (en) | The kneed forecast Control Algorithm of active above-knee prosthesis | |
| CN113642379B (en) | Human body posture prediction method and system based on attention mechanism fusion multi-flow diagram | |
| Huang et al. | Optimisation of reference gait trajectory of a lower limb exoskeleton | |
| Liang et al. | Synergy-based knee angle estimation using kinematics of thigh | |
| CN116115217B (en) | Human lower limb gait phase estimation method based on depth network | |
| CN115798042A (en) | Escalator passenger abnormal behavior data construction method based on digital twins | |
| CN115363907A (en) | Rehabilitation decision-making method based on virtual reality rehabilitation training system | |
| Qianwen | Application of motion capture technology based on wearable motion sensor devices in dance body motion recognition | |
| CN117519489A (en) | Vibrotactile actuator and control method, evaluation method and wearable rehabilitation device | |
| CN111341412B (en) | Lower limb rehabilitation type exoskeleton gait planning method based on RBF-DMP oscillator | |
| CN117077517A (en) | Human body walking lower limb muscle force solving device and method based on generation of countermeasure network and reinforcement learning | |
| Robson et al. | Creating a virtual perception for upper limb rehabilitation | |
| Demircan et al. | Human motion reconstruction and synthesis of human skills | |
| Zarshenas et al. | Ankle torque forecasting using time-delayed neural networks | |
| CN110473602B (en) | A body posture data collection and processing method for wearable somatosensory game equipment | |
| Tao et al. | Human modeling and real-time motion reconstruction for micro-sensor motion capture | |
| CN115543094B (en) | Interaction method, system and electronic equipment of digital twin virtual person and human body | |
| Liu et al. | A Dual-module Driven Method for Foot Posture Indirect Measurement with Potential Application in Rehabilitation Robots | |
| Kun et al. | Shoulder joint rehabilitation training system based on virtual reality technology |
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 |