CN103832504A - Bionic foot-type robot comprehensive simulation strategy - Google Patents

Bionic foot-type robot comprehensive simulation strategy Download PDF

Info

Publication number
CN103832504A
CN103832504A CN201410064577.9A CN201410064577A CN103832504A CN 103832504 A CN103832504 A CN 103832504A CN 201410064577 A CN201410064577 A CN 201410064577A CN 103832504 A CN103832504 A CN 103832504A
Authority
CN
China
Prior art keywords
bionic
robot
matlab
simulation
simulink
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
CN201410064577.9A
Other languages
Chinese (zh)
Other versions
CN103832504B (en
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.)
Nanjing University of Aeronautics and Astronautics
Original Assignee
Nanjing University of Aeronautics and Astronautics
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 Nanjing University of Aeronautics and Astronautics filed Critical Nanjing University of Aeronautics and Astronautics
Priority to CN201410064577.9A priority Critical patent/CN103832504B/en
Publication of CN103832504A publication Critical patent/CN103832504A/en
Application granted granted Critical
Publication of CN103832504B publication Critical patent/CN103832504B/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Manipulator (AREA)

Abstract

一种仿生足式机器人综合仿真策略,属于机器人技术应用领域。本发明系统包括:基于Matlab/Simulink仿生足式机器人控制模型(A)、基于Matlab/SimMechanics仿生足式机器人运动学仿真模型(B)、基于ADAMS仿生足式机器人动力学模型(C)、仿生足式机器人实验样机(D)。所述综合仿真策略包括机器人实验样机的运动状态实时运动学和动力学演示方法、机器人步态生成仿真验证后的机器人实验样机的实时运动控制方法、机器人虚拟联合仿真、半实物仿真的自学习调整方法和机器人自适应多协调控制方法。本发明具有成本低、功能多特点,基本覆盖传统仿生足式机器人仿真调试要求,具有一定的普遍适用性。

The invention discloses a comprehensive simulation strategy of a bionic legged robot, which belongs to the field of robot technology application. The system of the present invention comprises: based on Matlab/Simulink bionic footed robot control model (A), based on Matlab/SimMechanics bionic footed robot kinematics simulation model (B), based on ADAMS bionic footed robot dynamics model (C), bionic foot Experimental prototype of the robot (D). The comprehensive simulation strategy includes the real-time kinematics and dynamics demonstration method of the motion state of the robot experimental prototype, the real-time motion control method of the robot experimental prototype after the robot gait generation simulation verification, the robot virtual co-simulation, and the self-learning adjustment of the hardware-in-the-loop simulation method and method for adaptive multi-coordinated control of robots. The invention has the characteristics of low cost and multiple functions, basically covers the simulation debugging requirements of the traditional bionic legged robot, and has certain universal applicability.

Description

仿生足式机器人综合仿真策略Synthetic Simulation Strategy of Bionic Legged Robot

技术领域 technical field

本发明属于机器人技术应用领域,具体涉及一种基于Matlab、ADAMS和半实物联合仿真的仿生足式机器人综合仿真策略,主要应用于仿生足式机器人运动演示、步态生成、自学习和多协调控制。 The invention belongs to the application field of robot technology, and specifically relates to a comprehensive simulation strategy of a bionic legged robot based on Matlab, ADAMS and semi-physical joint simulation, which is mainly used in motion demonstration, gait generation, self-learning and multi-coordination control of a bionic legged robot .

背景技术 Background technique

仿生足式机器人是当今机器人研究领域最为前沿的课题之一,它集机械、电子、计算机、材料、传感器、控制技术及人工智能等多门学科于一体,反映了一个国家的智能化和自动化研究水平,同时也作为一个国家高科技实力的重要标志,各发达国家在该领域相继投入巨资开展研究。 Bionic footed robot is one of the most cutting-edge topics in the field of robot research today. It integrates many disciplines such as machinery, electronics, computers, materials, sensors, control technology and artificial intelligence, reflecting a country's intelligence and automation research. At the same time, as an important symbol of a country's high-tech strength, developed countries have invested heavily in research in this field.

仿生足式机器人比轮式、履带式机器人更具备优越的移动能力,能够适应复杂多变的非结构自然环境要求。由于其具备更多的关节自由度,也使得调试控制仿生足式机器人更具有难度。通常采用虚拟仿真方法作为机器人设计前期验证阶段,如梁青等人发表的基于ADAMS的双足机器人建模与仿真(《计算机仿真》2010年 第5期)、后期调试时可采用半实物仿真板卡(如dSPACE半实物仿真平台)进行半实物调试,如李学军等人发表的基于dSPACE半实物仿真平台设计(《长春大学学报》 2011年06期)。 Compared with wheeled and tracked robots, bionic legged robots have superior mobility and can adapt to complex and changeable unstructured natural environments. Because it has more joint degrees of freedom, it is more difficult to debug and control the bionic legged robot. The virtual simulation method is usually used as the pre-verification stage of the robot design, such as the biped robot modeling and simulation based on ADAMS published by Liang Qing et al. ("Computer Simulation" 2010 No. 5), and the semi-physical simulation board can be used for later debugging. Card (such as dSPACE hardware-in-the-loop simulation platform) for hardware-in-the-loop debugging, such as the design based on dSPACE hardware-in-the-loop simulation platform published by Li Xuejun and others ("Journal of Changchun University" 2011 06).

由于各个仿真软件有其各自优缺点,也有采用2个仿真软件进行联合仿真(如刘小成等人发表的仿蟹机器人基于MATLAB与ADAMS单足联合仿真分析(《微计算机信息》 2010年 第14期)),但纯粹虚拟联合仿真结果往往与实际实验数据相差较大,不具有一定的实际指导意义;单一的基于半实物仿真板卡的半实物仿真,不但依赖于现有高科技集成硬件和软件(费用较高、对仿生足式机器人运动控制调试适应性不强等弊端),且与其他虚拟仿真软件不宜兼容。 Since each simulation software has its own advantages and disadvantages, two simulation software are also used for joint simulation (for example, Liu Xiaocheng et al. published a joint simulation analysis of imitation crab robot based on MATLAB and ADAMS single foot ("Microcomputer Information" 2010 No. 14) ), but the results of pure virtual co-simulation are often quite different from the actual experimental data, and do not have certain practical guiding significance; a single half-physical simulation based on half-physical simulation boards not only relies on existing high-tech integrated hardware and software ( High cost, poor adaptability to bionic legged robot motion control debugging, etc.), and it is not compatible with other virtual simulation software.

针对以上情况,本发明提出了一种基于Matlab、ADAMS和半实物联合仿真的仿生足式机器人综合仿真策略,其特征在于利用各种虚拟仿真软件擅长的优点进行分工联合仿真,借用仿生足式机器人样机无线发射装置与计算机控制平台进行无线数据传输,真正发挥了Matlab、ADAMS和半实物联合仿真的优势,可实现仿生足式机器人运动调试的多种功能,具体包括:仿生足式机器人运动演示、步态生成、自学习和多协调控制。 For above situation, the present invention proposes a kind of bionic legged robot comprehensive simulation strategy based on Matlab, ADAMS and half-in-the-loop joint simulation, it is characterized in that utilize the advantage that various virtual simulation software is good at to carry out division of labor joint simulation, borrow bionic legged robot The wireless transmission device of the prototype and the computer control platform carry out wireless data transmission, which really exerts the advantages of Matlab, ADAMS and half-in-the-loop joint simulation, and can realize various functions of bionic legged robot motion debugging, including: bionic legged robot motion demonstration, Gait generation, self-learning and multi-coordination control.

基于Matlab、ADAMS和半实物联合仿真的仿生足式机器人运动演示、步态生成、自学习和多协调控制策略,创新性地提出了集多功能的调试策略,为仿生足式机器人全面运动控制调试提供新的思路和方法,具有很重要的理论意义和实用价值。 Based on the motion demonstration, gait generation, self-learning and multi-coordination control strategies of bionic legged robots based on Matlab, ADAMS and hardware-in-the-loop co-simulation, a multi-functional debugging strategy is innovatively proposed to provide comprehensive motion control debugging for bionic legged robots It provides new ideas and methods, which have very important theoretical significance and practical value.

发明内容 Contents of the invention

本发明的目的在于提供一种基于Matlab、ADAMS和半实物联合仿真的仿生足式机器人综合仿真策略。 The purpose of the present invention is to provide a bionic legged robot comprehensive simulation strategy based on Matlab, ADAMS and hardware-in-the-loop joint simulation.

一种基于Matlab、ADAMS和半实物联合仿真的仿生足式机器人综合仿真策略,其特征在于: A kind of bionic legged robot comprehensive simulation strategy based on Matlab, ADAMS and hardware-in-the-loop co-simulation, is characterized in that:

所用系统包括:基于Matlab/Simulink仿生足式机器人控制模型、基于Matlab/SimMechanics仿生足式机器人运动学仿真模型、基于ADAMS仿生足式机器人动力学模型、仿生足式机器人实验样机。 The systems used include: the control model of the bionic footed robot based on Matlab/Simulink, the kinematics simulation model of the bionic footed robot based on Matlab/SimMechanics, the dynamics model of the bionic footed robot based on ADAMS, and the experimental prototype of the bionic footed robot.

所述策略包括机器人实验样机的运动状态实时运动学演示过程,具体方式:仿生足式机器人实验样机无线发送接口机器人环境感知和实时运动反馈数据到基于Matlab/Simulink仿生足式机器人控制模型中,基于Matlab/Simulink仿生足式机器人控制模型传输足端运动轨迹和步态参数到基于Matlab/SimMechanics仿生足式机器人运动学仿真模型中,而Matlab/SimMechanics中具有相关的机构运动学动画演示功能,实时显示机器人实验样机的运动学状态,相关的关节运动轨迹和步态数据传输到基于Matlab/Simulink仿生足式机器人控制模型中,进行运动学数据汇总和保存; The strategy includes the real-time kinematics demonstration process of the motion state of the robot experimental prototype. The specific method is: the bionic legged robot experimental prototype wirelessly sends interface robot environment perception and real-time motion feedback data to the bionic legged robot control model based on Matlab/Simulink, based on The Matlab/Simulink bionic footed robot control model transmits the foot end trajectory and gait parameters to the bionic footed robot kinematics simulation model based on Matlab/SimMechanics, and Matlab/SimMechanics has the relevant mechanism kinematics animation demonstration function, real-time display The kinematic state of the robot experimental prototype, the relevant joint motion trajectory and gait data are transmitted to the bionic legged robot control model based on Matlab/Simulink, and the kinematic data is summarized and saved;

所述策略包括机器人实验样机运动状态实时动力学演示过程,具体方式:仿生足式机器人实验样机无线发送接口机器人环境感知和实时运动反馈数据到基于Matlab/Simulink仿生足式机器人控制模型中,基于Matlab/Simulink仿生足式机器人控制模型传输运动步态和姿态数据传输到基于ADAMS仿生足式机器人动力学模型中,而ADAMS中具有相关的机构动力学动画演示功能,可实时显示机器人实验样机的动力学数据,相关的动力学联合仿真输出数据到基于Matlab/Simulink仿生足式机器人控制模型中,进行动力学数据汇总和保存; The strategy includes the real-time dynamics demonstration process of the motion state of the experimental prototype of the robot. The specific method is: the experimental prototype of the bionic legged robot wirelessly transmits the environment perception and real-time motion feedback data of the interface robot to the control model of the bionic legged robot based on Matlab/Simulink, and based on Matlab /Simulink bionic legged robot control model transfers motion gait and attitude data to the bionic legged robot dynamics model based on ADAMS, and ADAMS has related mechanism dynamics animation demonstration functions, which can display the dynamics of the robot experimental prototype in real time Data, related dynamics co-simulation output data to the control model based on Matlab/Simulink bionic legged robot, and dynamic data collection and storage;

所述策略包括机器人纯虚拟联合运动仿真过程,具体方式:基于Matlab/Simulink仿生足式机器人控制模型传输足端运动轨迹和步态参数到基于Matlab/SimMechanics仿生足式机器人运动学仿真模型,经Matlab/SimMechanics仿真后将关节运动轨迹和步态数据汇总到基于Matlab/Simulink仿生足式机器人控制模型,基于Matlab/Simulink仿生足式机器人控制模型将运动步态和姿态数据发送给基于ADAMS仿生足式机器人动力学模型,经ADAMS动力学仿真后,将动力学联合仿真输出数据汇总到基于Matlab/Simulink仿生足式机器人控制模型,完成了Matlab/SimMechanics和ADAMS的联合运动仿真; The strategy includes the pure virtual joint motion simulation process of the robot. The specific method is: based on the Matlab/Simulink bionic footed robot control model, the foot end motion trajectory and gait parameters are transmitted to the Matlab/SimMechanics bionic footed robot kinematics simulation model, and the robot is passed through Matlab. After /SimMechanics simulation, the joint motion trajectory and gait data are summarized to the control model of the bionic footed robot based on Matlab/Simulink, and the motion gait and posture data are sent to the bionic footed robot based on ADAMS based on the control model of the bionic footed robot based on Matlab/Simulink Dynamics model, after ADAMS dynamics simulation, the output data of dynamics co-simulation is summarized to the control model of bionic legged robot based on Matlab/Simulink, and the joint kinematics simulation of Matlab/SimMechanics and ADAMS is completed;

所述策略包括机器人步态生成、机器人实验样机的实时运动控制过程,具体方式:基于Matlab/Simulink仿生足式机器人控制模型传输足端运动轨迹和步态参数到基于Matlab/SimMechanics仿生足式机器人运动学仿真模型,经Matlab/SimMechanics仿真后将关节运动轨迹和步态数据汇总到基于Matlab/Simulink仿生足式机器人控制模型,基于Matlab/Simulink仿生足式机器人控制模型将机器人运动步态数据包和协调控制指令参数无线发送给仿生足式机器人实验样机,完成了由Matlab/SimMechanics步态生成后数据实时控制机器人实验样机运动; The strategy includes robot gait generation and the real-time motion control process of the robot experimental prototype. The specific method is: based on the Matlab/Simulink bionic legged robot control model, the foot end trajectory and gait parameters are transmitted to the bionic legged robot based on Matlab/SimMechanics. After Matlab/SimMechanics simulation, the joint motion trajectory and gait data are summarized into the control model of the bionic legged robot based on Matlab/Simulink, and the robot motion gait data package and coordination are based on the Matlab/Simulink bionic legged robot control model. The control command parameters are wirelessly sent to the bionic legged robot experimental prototype, and the data generated by Matlab/SimMechanics gait is completed to control the movement of the robot experimental prototype in real time;

所述策略包括机器人步态生成、仿真验证后的机器人实验样机的实时运动控制过程,具体方式:基于Matlab/Simulink仿生足式机器人控制模型传输足端运动轨迹和步态参数到基于Matlab/SimMechanics仿生足式机器人运动学仿真模型,经Matlab/SimMechanics仿真后将关节运动轨迹和步态数据汇总到基于Matlab/Simulink仿生足式机器人控制模型(A),基于Matlab/Simulink仿生足式机器人控制模型将运动步态和姿态数据发送给基于ADAMS仿生足式机器人动力学模型,经ADAMS动力学仿真后,将动力学联合仿真输出数据汇总到基于Matlab/Simulink仿生足式机器人控制模型,完成了Matlab/SimMechanics步态生成和ADAMS的联合运动仿真验证,再将机器人运动步态数据包和协调控制指令参数无线发送给仿生足式机器人实验样机,完成了由Matlab/SimMechanics步态生成和ADAMS的联合运动仿真验证后数据实时控制机器人实验样机运动,更准确地实现了机器人实验样机的运动控制; The strategy includes robot gait generation and the real-time motion control process of the robot experimental prototype after simulation verification. The specific method is: based on the Matlab/Simulink bionic legged robot control model, the foot end motion trajectory and gait parameters are transmitted to the Matlab/SimMechanics bionic robot control model. Footed robot kinematics simulation model, after Matlab/SimMechanics simulation, the joint motion trajectory and gait data are summarized into a bionic footed robot control model based on Matlab/Simulink (A), based on Matlab/Simulink bionic footed robot control model The gait and attitude data are sent to the dynamic model of the bionic footed robot based on ADAMS. After the dynamics simulation of ADAMS, the output data of the dynamics co-simulation is summarized to the control model of the bionic footed robot based on Matlab/Simulink, and the Matlab/SimMechanics step is completed. After completing the joint motion simulation verification of Matlab/SimMechanics gait generation and ADAMS The data controls the movement of the robot experimental prototype in real time, and realizes the motion control of the robot experimental prototype more accurately;

所述策略包括机器人虚拟联合仿真自学习调整过程,具体方式:基于Matlab/Simulink仿生足式机器人控制模型传输足端运动轨迹和步态参数到基于Matlab/SimMechanics仿生足式机器人运动学仿真模型,经Matlab/SimMechanics仿真后将关节运动轨迹和步态数据汇总到基于Matlab/Simulink仿生足式机器人控制模型,基于Matlab/Simulink仿生足式机器人控制模型将运动步态和姿态数据发送给基于ADAMS仿生足式机器人动力学模型,经ADAMS动力学仿真后,将动力学联合仿真输出数据汇总到基于Matlab/Simulink仿生足式机器人控制模型,完成了一次Matlab/SimMechanics和ADAMS的联合运动仿真,通过基于Matlab/Simulink仿生足式机器人控制模型中自学习模块调整参数,进行连续循环仿真,最终实现虚拟联合仿真自学习调整,为数据优化和自适应控制提供依据; The strategy includes the robot virtual co-simulation self-learning adjustment process, the specific way: based on the control model of the Matlab/Simulink bionic legged robot, the trajectory of the foot end and the gait parameters are transmitted to the kinematics simulation model of the bionic legged robot based on Matlab/SimMechanics. After Matlab/SimMechanics simulation, the joint motion trajectory and gait data are summarized to the control model of the bionic footed robot based on Matlab/Simulink, and the motion gait and attitude data are sent to the bionic footed robot based on ADAMS based on the control model of the Matlab/Simulink bionic footed robot The robot dynamics model, after the ADAMS dynamics simulation, aggregates the output data of the dynamics co-simulation to the bionic legged robot control model based on Matlab/Simulink, and completes a joint kinematics simulation of Matlab/SimMechanics and ADAMS. The self-learning module in the bionic legged robot control model adjusts parameters, performs continuous cycle simulation, and finally realizes virtual co-simulation self-learning adjustment, providing a basis for data optimization and adaptive control;

所述策略包括机器人半实物仿真自学习调整过程,具体方式:基于Matlab/Simulink仿生足式机器人控制模型传输足端运动轨迹和步态参数到基于Matlab/SimMechanics仿生足式机器人运动学仿真模型,经Matlab/SimMechanics仿真后将关节运动轨迹和步态数据汇总到基于Matlab/Simulink仿生足式机器人控制模型,基于Matlab/Simulink仿生足式机器人控制模型将机器人运动步态数据包和协调控制指令参数发送给仿生足式机器人实验样机,经机器人实验样机运动实验后,将机器人环境感知和实时运动反馈数据汇总到基于Matlab/Simulink仿生足式机器人控制模型,完成了一次Matlab/SimMechanics和半实物实验样机的联合运动仿真,通过基于Matlab/Simulink仿生足式机器人控制模型中自学习模块调整参数,进行连续循环半实物仿真,最终实现半实物联合仿真下的自学习调整,为数据优化和自适应控制提供依据; The strategy includes the self-learning adjustment process of robot half-in-the-loop simulation. The specific method is: based on the control model of the Matlab/Simulink bionic legged robot, the trajectory of the foot end and the gait parameters are transmitted to the kinematics simulation model of the bionic legged robot based on Matlab/SimMechanics. After Matlab/SimMechanics simulation, the joint motion trajectory and gait data are summarized to the control model of the bionic legged robot based on Matlab/Simulink, and the robot motion gait data packet and coordination control command parameters are sent to the The experimental prototype of the bionic legged robot, after the motion experiment of the robot experimental prototype, summarized the robot environment perception and real-time motion feedback data into the control model of the bionic legged robot based on Matlab/Simulink, and completed a combination of Matlab/SimMechanics and the semi-physical experimental prototype Motion simulation, by adjusting the parameters of the self-learning module based on the Matlab/Simulink bionic legged robot control model, conduct continuous loop hardware-in-the-loop simulation, and finally realize the self-learning adjustment under the hardware-in-the-loop joint simulation, providing a basis for data optimization and adaptive control;

所述策略包括机器人自适应多协调控制过程,具体方式:基于Matlab/Simulink仿生足式机器人控制模型传输足端运动轨迹和步态参数到基于Matlab/SimMechanics仿生足式机器人运动学仿真模型,经Matlab/SimMechanics仿真后将关节运动轨迹和步态数据汇总到基于Matlab/Simulink仿生足式机器人控制模型,基于Matlab/Simulink仿生足式机器人控制模型将运动步态和姿态数据发送给基于ADAMS仿生足式机器人动力学模型,经ADAMS动力学仿真后,将动力学联合仿真输出数据汇总到基于Matlab/Simulink仿生足式机器人控制模型;在此同时,基于Matlab/Simulink仿生足式机器人控制模型,将机器人运动步态数据包和协调控制指令参数发送给仿生足式机器人实验样机,经机器人实验样机运动实验后,将机器人环境感知和实时运动反馈数据汇总到基于Matlab/Simulink仿生足式机器人控制模型;整合动力学联合仿真输出数据和实时运动反馈数据,两者数据进行互补和自学习调控,完成了在实际机器人样机缺失部分传感信息的条件下,借助仿真数据实现机器人自适应多协调控制。 The strategy includes the robot self-adaptive multi-coordination control process, and the specific method is: based on the Matlab/Simulink bionic footed robot control model, the foot end motion trajectory and gait parameters are transmitted to the bionic footed robot kinematics simulation model based on Matlab/SimMechanics, and the After /SimMechanics simulation, the joint motion trajectory and gait data are summarized to the control model of the bionic footed robot based on Matlab/Simulink, and the motion gait and posture data are sent to the bionic footed robot based on ADAMS based on the control model of the bionic footed robot based on Matlab/Simulink Dynamics model, after ADAMS dynamics simulation, the dynamics co-simulation output data is summarized to the control model of the bionic footed robot based on Matlab/Simulink; at the same time, based on the Matlab/Simulink bionic footed robot control model, the robot motion step State data packets and coordination control instruction parameters are sent to the bionic legged robot experimental prototype. After the robot experimental prototype motion experiment, the robot environment perception and real-time motion feedback data are summarized into the bionic legged robot control model based on Matlab/Simulink; integrated dynamics Co-simulation output data and real-time motion feedback data, the two data are complementary and self-learning control, and the robot adaptive multi-coordination control is realized with the help of simulation data under the condition that the actual robot prototype lacks part of the sensor information.

所述的基于Matlab、ADAMS和半实物联合仿真的仿生足式机器人综合仿真策略,其特征在于:所述的基于Matlab/Simulink仿生足式机器人控制模型搭建方式,具体方式:首先在Matlab/Simulink仿生足式机器人仿真系统中设置如系统内部仿真算法类型、周期、步长、误差范围的参数,接着根据实现机器人调试所需选择性地建立基于Matlab/Simulink的仿生足式机器人运动演示模块、建立基于Matlab/Simulink的仿生足式机器人运动步态控制模块、建立基于Matlab/Simulink的仿生足式机器人运动自学习模块和建立基于Matlab/Simulink的仿生足式机器人协调控制模块,最后连接Matlab/Simulink仿生足式机器人仿真系统接口,进行数据交换,协调数据处理。 The described bionic legged robot comprehensive simulation strategy based on Matlab, ADAMS and half-in-the-loop co-simulation is characterized in that: the described bionic legged robot control model based on Matlab/Simulink is built, in a specific way: first in Matlab/Simulink bionic In the footed robot simulation system, parameters such as the type of simulation algorithm, period, step size, and error range within the system are set, and then a bionic footed robot motion demonstration module based on Matlab/Simulink is selectively established according to the needs of robot debugging. Matlab/Simulink's bionic legged robot motion gait control module, establish a bionic legged robot motion self-learning module based on Matlab/Simulink and establish a bionic legged robot coordination control module based on Matlab/Simulink, and finally connect Matlab/Simulink bionic foot The robot simulation system interface is used to exchange data and coordinate data processing.

所述的基于Matlab、ADAMS和半实物联合仿真的仿生足式机器人综合仿真策略,其特征在于:所述的基于Matlab/SimMechanics仿生足式机器人运动学仿真模型搭建方式,具体方式:首先创建Matlab/SimMechanics仿生足式机器人运动学仿真环境,设定系统环境参数,接着在Matlab/SimMechanics中建立仿生足式机器人系统世界坐标系和各腿运动关节的自由度数及方向,设置包括质量、惯量、长度的各腿杆件刚体参数、关节控制器类型、关节传感器输出类型,最后根据机器人运动控制要求,引出Matlab/SimMechanics仿生足式机器人运动学仿真模型中的输入和输出接口,准备接受关节输入数据和发送关节输出数据,进行数据交换,实现运动学运算功能。 The described bionic legged robot comprehensive simulation strategy based on Matlab, ADAMS and half-in-the-loop joint simulation is characterized in that: the described bionic legged robot kinematics simulation model based on Matlab/SimMechanics is built, and the specific method: first create Matlab/SimMechanics SimMechanics bionic footed robot kinematics simulation environment, set the system environment parameters, and then establish the world coordinate system of the bionic footed robot system and the degrees of freedom and directions of the kinematic joints of each leg in Matlab/SimMechanics, setting parameters including mass, inertia, and length Rigid body parameters of each leg member, joint controller type, joint sensor output type, and finally, according to the robot motion control requirements, lead out the input and output interfaces in the Matlab/SimMechanics bionic footed robot kinematics simulation model, ready to accept joint input data and send The joints output data, exchange data, and realize kinematic calculation functions.

所述的基于Matlab、ADAMS和半实物联合仿真的仿生足式机器人综合仿真策略,其特征在于:所述的基于ADAMS仿生足式机器人动力学模型搭建方式,具体方式:首先创建ADAMS仿生足式机器人动力学仿真环境,设定系统环境参数,接着在ADAMS中导入地面刚体、仿生足式机器人各腿杆件刚体,设定刚体几何尺寸、材料类型或密度或质量参数,然后在ADAMS中设定各刚体之间关节自由度数及关节类型,并在ADAMS中设定各足端与地面刚体之间碰撞类型、摩擦约束及相关参数设定,最后根据实际要求,设定ADAMS仿生足式机器人运动学仿真模型中的输入和输出接口,准备接受关节输入数据、发送关节输出数据和足端碰撞力数据,进行数据交换,实现动力学运算功能。 The comprehensive simulation strategy of the bionic legged robot based on Matlab, ADAMS and half-in-the-loop co-simulation is characterized in that: the described ADAMS bionic legged robot dynamics model building method is based on the specific method: first create the ADAMS bionic legged robot Dynamics simulation environment, set the system environment parameters, and then import the ground rigid body and the rigid body of each leg of the bionic legged robot in ADAMS, set the rigid body geometric size, material type or density or quality parameters, and then set each in ADAMS Joint degrees of freedom and joint types between rigid bodies, and set the collision type, friction constraints and related parameter settings between each foot end and ground rigid body in ADAMS, and finally set ADAMS bionic legged robot kinematics simulation according to actual requirements The input and output interfaces in the model are ready to receive joint input data, send joint output data and foot collision force data, exchange data, and realize dynamic calculation functions.

所述的基于Matlab、ADAMS和半实物联合仿真的仿生足式机器人综合仿真策略,其特征在于:所述的仿生足式机器人实验样机操作流程,具体方式:首先仿生足式机器人实验样机进行初始化,设定包括系统初始化参数,接着仿生足式机器人实验样机无线接收上层任务控制指令信号和步态数据,然后进行仿生足式机器人实验样机运动实验,同时把实验过程中实时将仿生足式机器人实验样机自身感知的姿态传感、关节角度、角速度、足端力信息和仿生足式机器人实验样机环境识别的红外测距、机器视觉识别障碍物分布、地面状况信息无线发送给计算机控制平台。本发明的工作原理: The comprehensive simulation strategy of the bionic legged robot based on Matlab, ADAMS and half-in-the-loop joint simulation is characterized in that: the operation process of the bionic legged robot experimental prototype, in a specific way: first the bionic legged robot experimental prototype is initialized, The settings include system initialization parameters, and then the bionic legged robot experimental prototype wirelessly receives the upper-level task control command signal and gait data, and then performs the motion experiment of the bionic legged robot experimental prototype. Self-perceived attitude sensing, joint angles, angular velocities, foot end force information, and infrared distance measurement for environment recognition of the bionic legged robot experimental prototype, machine vision recognition of obstacle distribution, and ground condition information are sent to the computer control platform wirelessly. Working principle of the present invention:

基于Matlab/SimMechanics在仿生足式机器人运动学计算优点,分析机器人步态生成,得到的数据作为机器人运动参考依据;基于ADAMS在仿生足式机器人动力学计算优点,分析机器人在运动环境下的动力学特性,相关的数据作为仿生足式机器人动力学稳定评判依据;通过计算机控制平台的仿生足式机器人软件联合仿真环境建立,实现数据交换和互补,通过仿生足式机器人实验样机的无线发送和接收装置,进行与实验样机的半实物调试,其中由计算机控制平台发送仿真验证后的步态数据和协调控制指令,实验样机进行运动实验,相关样机上的传感器信息通过无线发送装置反馈给计算机控制平台,由相应仿真模块实现运动步态的各种调试功能(包括:运动演示、步态生成、自学习和多协调控制等)。 Based on the advantages of Matlab/SimMechanics in the calculation of bionic legged robot kinematics, analyze the robot gait generation, and the obtained data is used as a reference for robot motion; based on the advantages of ADAMS in the calculation of bionic legged robot dynamics, analyze the dynamics of the robot in the motion environment The characteristics and related data are used as the basis for evaluating the dynamic stability of the bionic legged robot; through the establishment of the bionic legged robot software joint simulation environment on the computer control platform, data exchange and complementarity are realized, and the wireless sending and receiving device of the bionic legged robot experimental prototype , carry out semi-physical debugging with the experimental prototype, in which the computer control platform sends the simulated and verified gait data and coordination control instructions, the experimental prototype performs motion experiments, and the sensor information on the relevant prototype is fed back to the computer control platform through the wireless sending device. Various debugging functions of motion gait are realized by corresponding simulation modules (including: motion demonstration, gait generation, self-learning and multi-coordination control, etc.).

本发明与现有技术相比有如下优点: Compared with the prior art, the present invention has the following advantages:

1、 本发明能够基于Matlab/SimMechanics和ADAMS的各自仿真优势,集成联合仿真应用,具有分工明确、思路清晰、确实可行的特点,有助于前期理论研究,为后期样机实验调试提供较为准确的参考数据。 1. The present invention can integrate joint simulation applications based on the respective simulation advantages of Matlab/SimMechanics and ADAMS. It has the characteristics of clear division of labor, clear thinking, and practicality. It is helpful for the theoretical research in the early stage and provides a more accurate reference for later prototype experiment debugging. data.

2、 本发明的成本低、实现功能多,基本覆盖传统仿生足式机器人控制调试要求,具有一定的普遍适用性。 2. The invention has low cost and multiple functions, basically covers the control and debugging requirements of traditional bionic legged robots, and has certain universal applicability.

3、 本发明给仿生足式机器人控制调试提供一种新方案,提高了仿生足式机器人技术研发效率,提供了拓宽了仿真应用范围。 3. The present invention provides a new solution for the control and debugging of the bionic legged robot, improves the research and development efficiency of the bionic legged robot technology, and provides a broadened range of simulation applications.

附图说明 Description of drawings

图1是本发明一种基于Matlab、ADAMS和半实物联合仿真的仿生足式机器人综合仿真策略框图。 Fig. 1 is a block diagram of a comprehensive simulation strategy of a bionic legged robot based on Matlab, ADAMS and hardware-in-the-loop joint simulation of the present invention.

图2是本发明中基于Matlab/Simulink仿生足式机器人控制模型搭建方式流程图。 Fig. 2 is the flow chart of the way of building the control model of the bionic legged robot based on Matlab/Simulink in the present invention.

图3是本发明中基于Matlab/SimMechanics仿生足式机器人运动学仿真模型搭建方式流程图。 Fig. 3 is a flow chart of the method for building a kinematics simulation model of a bionic legged robot based on Matlab/SimMechanics in the present invention.

图4是本发明中基于ADAMS仿生足式机器人动力学模型搭建方式流程图。 Fig. 4 is a flow chart of the building method of the dynamic model based on ADAMS bionic legged robot in the present invention.

图5是本发明中仿生足式机器人实验样机操作流程图。 Fig. 5 is a flowchart of the operation of the experimental prototype of the bionic legged robot in the present invention.

上述图中标号名称:A、基于Matlab/Simulink仿生足式机器人控制模型;B、基于Matlab/SimMechanics仿生足式机器人运动学仿真模型;C、基于ADAMS仿生足式机器人动力学模型;D、仿生足式机器人实验样机;1、足端运动轨迹和步态参数;2、关节运动轨迹和步态数据;3、动力学联合仿真输出数据;4、运动步态和姿态数据;5、机器人环境感知和实时运动反馈数据;6、机器人运动步态数据包和协调控制指令参数。 Label names in the above figures: A, Matlab/Simulink-based bionic legged robot control model; B, Matlab/SimMechanics-based bionic legged robot kinematics simulation model; C, ADAMS-based bionic legged robot dynamics model; D, bionic legged robot 1. Foot movement trajectory and gait parameters; 2. Joint movement trajectory and gait data; 3. Dynamics co-simulation output data; 4. Motion gait and posture data; Real-time motion feedback data; 6. Robot motion gait data packets and coordination control instruction parameters.

图中A和B组成部分属于基于Matlab仿生足式机器人软件仿真环境,A、B和C组成部分属于基于计算机控制平台的仿生足式机器人软件联合仿真环境。 The components A and B in the figure belong to the simulation environment of the bionic footed robot software based on Matlab, and the components A, B and C belong to the joint simulation environment of the bionic footed robot software based on the computer control platform.

具体实施方式 Detailed ways

下面结合附图和具体实施例对本发明作进一步详细说明: Below in conjunction with accompanying drawing and specific embodiment the present invention is described in further detail:

结合图1、2、3,本实施例为一种基于Matlab、ADAMS和半实物联合仿真的仿生足式机器人综合仿真策略框图,包括:基于Matlab/Simulink仿生足式机器人控制模型A、基于Matlab/SimMechanics仿生足式机器人运动学仿真模型B、基于ADAMS仿生足式机器人动力学模型C、仿生足式机器人实验样机D、足端运动轨迹和步态参数1、关节运动轨迹和步态数据2;动力学联合仿真输出数据3、运动步态和姿态数据4、机器人环境感知和实时运动反馈数据5、机器人运动步态数据包和协调控制指令参数6。 In conjunction with Fig. 1, 2, 3, the present embodiment is a block diagram of a comprehensive simulation strategy for a bionic footed robot based on Matlab, ADAMS and half-in-the-loop co-simulation, including: based on Matlab/Simulink bionic footed robot control model A, based on Matlab/ SimMechanics bionic footed robot kinematics simulation model B, bionic footed robot dynamics model C based on ADAMS, bionic footed robot experimental prototype D, foot end movement trajectory and gait parameters 1, joint movement trajectory and gait data 2; power Joint simulation output data 3, motion gait and attitude data 4, robot environment perception and real-time motion feedback data 5, robot motion gait data package and coordination control instruction parameters 6.

其中基于Matlab/Simulink仿生足式机器人控制模型与基于Matlab/SimMechanics仿生足式机器人运动学仿真模型之间输入输出数据为足端运动轨迹和步态参数和关节运动轨迹和步态数据;基于Matlab/Simulink仿生足式机器人控制模型与基于ADAMS仿生足式机器人动力学模型之间输入输出数据为动力学联合仿真输出数据和运动步态和姿态数据;基于Matlab/Simulink仿生足式机器人控制模型与仿生足式机器人实验样机之间输入输出数据为机器人环境感知和实时运动反馈数据和机器人运动步态数据包和协调控制指令参数。 Among them, the input and output data between the control model of the bionic footed robot based on Matlab/Simulink and the kinematics simulation model of the bionic footed robot based on Matlab/SimMechanics are foot end motion trajectory and gait parameters and joint motion trajectory and gait data; based on Matlab/SimMechanics The input and output data between the control model of the Simulink bionic footed robot and the dynamic model of the bionic footed robot based on ADAMS are dynamics co-simulation output data and motion gait and posture data; the control model and the bionic footed robot based on Matlab/Simulink The input and output data between the robot experimental prototypes are robot environment perception and real-time motion feedback data, robot motion gait data packets and coordination control instruction parameters.

其中基于Matlab/Simulink仿生足式机器人控制模型与基于Matlab/SimMechanics仿生足式机器人运动学仿真模型组成了基于Matlab仿生足式机器人软件仿真环境;基于Matlab/Simulink仿生足式机器人控制模型、基于Matlab/SimMechanics仿生足式机器人运动学仿真模型和基于ADAMS仿生足式机器人动力学模型组成了基于计算机控制平台的仿生足式机器人软件联合仿真环境。 Among them, the bionic footed robot control model based on Matlab/Simulink and the kinematics simulation model based on Matlab/SimMechanics bionic footed robot software simulation environment based on Matlab bionic footed robot; the control model based on Matlab/Simulink bionic footed robot, based on Matlab/ SimMechanics bionic footed robot kinematics simulation model and bionic footed robot dynamics model based on ADAMS constitute the bionic footed robot software co-simulation environment based on computer control platform.

如图1所示一种基于Matlab、ADAMS和半实物联合仿真的仿生足式机器人综合仿真策略框图,其中基于Matlab/Simulink仿生足式机器人控制模型A与基于Matlab/SimMechanics仿生足式机器人运动学仿真模型B之间输入输出数据为足端运动轨迹和步态参数1和关节运动轨迹和步态数据2;基于Matlab/Simulink仿生足式机器人控制模型A与基于ADAMS仿生足式机器人动力学模型C之间输入输出数据为动力学联合仿真输出数据3和运动步态和姿态数据4;基于Matlab/Simulink仿生足式机器人控制模型A与仿生足式机器人实验样机D之间输入输出数据为机器人环境感知和实时运动反馈数据5和机器人运动步态数据包和协调控制指令参数6。 As shown in Figure 1, a bionic legged robot comprehensive simulation strategy block diagram based on Matlab, ADAMS and hardware-in-the-loop co-simulation, in which the bionic legged robot control model A based on Matlab/Simulink and the bionic legged robot kinematics simulation based on Matlab/SimMechanics The input and output data between model B are the foot end trajectory and gait parameters 1 and the joint movement trajectory and gait data 2; the control model A based on Matlab/Simulink bionic footed robot and the dynamic model C based on ADAMS bionic footed robot The input and output data between the dynamic co-simulation output data 3 and the motion gait and attitude data 4; the input and output data between the bionic legged robot control model A and the bionic legged robot experimental prototype D based on Matlab/Simulink are the robot environment perception and Real-time motion feedback data 5 and robot motion gait data packets and coordination control instruction parameters 6.

如图1所示一种基于Matlab、ADAMS和半实物联合仿真的仿生足式机器人综合仿真策略框图,其中基于Matlab/Simulink仿生足式机器人控制模型A与基于Matlab/SimMechanics仿生足式机器人运动学仿真模型B组成了基于Matlab仿生足式机器人软件仿真环境;基于Matlab/Simulink仿生足式机器人控制模型A、基于Matlab/SimMechanics仿生足式机器人运动学仿真模型B和基于ADAMS仿生足式机器人动力学模型C组成了基于计算机控制平台的仿生足式机器人软件联合仿真环境。 As shown in Figure 1, a bionic legged robot comprehensive simulation strategy block diagram based on Matlab, ADAMS and hardware-in-the-loop co-simulation, in which the bionic legged robot control model A based on Matlab/Simulink and the bionic legged robot kinematics simulation based on Matlab/SimMechanics Model B constitutes the simulation environment of the bionic footed robot based on Matlab; the control model A of the bionic footed robot based on Matlab/Simulink, the kinematics simulation model B of the bionic footed robot based on Matlab/SimMechanics and the dynamics model C of the bionic footed robot based on ADAMS The software co-simulation environment of the bionic legged robot based on the computer control platform is formed.

如图1所示一种基于Matlab、ADAMS和半实物联合仿真的仿生足式机器人综合仿真策略框图,其中机器人环境感知和实时运动反馈数据5和机器人运动步态数据包和协调控制指令参数6通过无线装置(如无线串口装置、无线wifi等设备)进行无线发送和接收。 As shown in Figure 1, a bionic footed robot comprehensive simulation strategy block diagram based on Matlab, ADAMS and hardware-in-the-loop co-simulation, in which the robot environment perception and real-time motion feedback data 5 and robot motion gait data packets and coordination control instruction parameters 6 are passed Wireless devices (such as wireless serial devices, wireless wifi and other equipment) perform wireless transmission and reception.

如图2所示基于Matlab/Simulink仿生足式机器人控制模型搭建方式流程图,首先在Matlab/Simulink仿生足式机器人仿真系统参数进行设置(如系统内部仿真算法类型、周期、步长、误差范围等参数设定),接着根据实现机器人调试所需选择性地建立基于Matlab/Simulink的仿生足式机器人运动演示模块、建立基于Matlab/Simulink的仿生足式机器人运动步态控制模块、建立基于Matlab/Simulink的仿生足式机器人运动自学习模块和建立基于Matlab/Simulink的仿生足式机器人协调控制模块,最后连接Matlab/Simulink仿生足式机器人仿真系统接口(包括数据流1、2、3、4、5、6的输入输出接口互连、进行数据交换,协调数据处理)。 As shown in Figure 2, based on the flow chart of the Matlab/Simulink bionic footed robot control model building method, first set the parameters of the Matlab/Simulink bionic footed robot simulation system (such as the type of simulation algorithm inside the system, period, step size, error range, etc. Parameter setting), and then selectively establish the motion demonstration module of the bionic legged robot based on Matlab/Simulink, establish the gait control module of the bionic legged robot based on Matlab/Simulink, and establish the gait control module based on Matlab/Simulink The bionic footed robot motion self-learning module and the establishment of the bionic footed robot coordination control module based on Matlab/Simulink, and finally connect the Matlab/Simulink bionic footed robot simulation system interface (including data streams 1, 2, 3, 4, 5, 6's input and output interfaces are interconnected for data exchange and coordinate data processing).

如图3所示基于Matlab/SimMechanics仿生足式机器人运动学仿真模型搭建方式流程图,首先创建Matlab/SimMechanics仿生足式机器人运动学仿真环境(包括系统环境参数设定),接着在Matlab/SimMechanics中建立仿生足式机器人系统世界坐标系(包括基座1、基座2等)、各腿运动关节(包括关节自由度数、方向等)、各腿杆件刚体参数(包括质量、惯量、长度等)、关节控制器类型、关节传感器输出类型等,最后根据机器人运动控制要求,引出Matlab/SimMechanics仿生足式机器人运动学仿真模型中的输入和输出接口(准备接受关节输入数据、发送关节输出数据,进行数据交换,实现运动学运算功能)。 As shown in Figure 3, the flow chart of the construction method of the kinematics simulation model based on Matlab/SimMechanics bionic footed robot, first create the Matlab/SimMechanics bionic footed robot kinematics simulation environment (including system environment parameter settings), and then create Establish the world coordinate system of the bionic legged robot system (including base 1, base 2, etc.), the kinematic joints of each leg (including joint degrees of freedom, direction, etc.), and the rigid body parameters of each leg member (including mass, inertia, length, etc.) , joint controller type, joint sensor output type, etc. Finally, according to the robot motion control requirements, the input and output interfaces in the Matlab/SimMechanics bionic legged robot kinematics simulation model (ready to receive joint input data, send joint output data, and Data exchange, realizing kinematics calculation function).

如图4所示基于ADAMS仿生足式机器人动力学模型搭建方式流程图,首先创建ADAMS仿生足式机器人动力学仿真环境(包括系统环境参数设定),接着在ADAMS中导入地面刚体、仿生足式机器人各腿杆件刚体等(设定刚体几何尺寸、材料类型或密度或质量等参数),然后在ADAMS中设定各刚体之间关节自由度数及关节类型,并在ADAMS中设定各足端与地面刚体之间碰撞类型、摩擦约束及相关参数设定,最后根据实际要求,设定ADAMS仿生足式机器人运动学仿真模型中的输入和输出接口(准备接受关节输入数据、发送关节输出数据和足端碰撞力等数据,进行数据交换,实现动力学运算功能)。 As shown in Figure 4, the flow chart of building a dynamic model based on the ADAMS bionic legged robot is first created. The dynamics simulation environment of the ADAMS bionic legged robot (including system environment Rigid bodies of each leg of the robot (set parameters such as rigid body geometry, material type or density or quality), and then set the degree of freedom and joint type of joints between each rigid body in ADAMS, and set each foot end in ADAMS Collision type with ground rigid body, friction constraints and related parameter settings, and finally according to actual requirements, set the input and output interfaces in the ADAMS bionic legged robot kinematics simulation model (ready to accept joint input data, send joint output data and foot impact force and other data, exchange data, and realize dynamic calculation function).

如图5所示仿生足式机器人实验样机操作流程图,首先仿生足式机器人实验样机进行初始化(包括系统参数初始化设定等),接着仿生足式机器人实验样机无线接收上层控制指令信号和步态数据(包括步态数据、任务指令等),然后进行仿生足式机器人实验样机运动实验,同时把实验过程中实时将仿生足式机器人实验样机自身感知信息无线发送(如陀螺仪、加速度计、地磁计等姿态传感器、关节角度和角速度传感器、足端力传感器等)和仿生足式机器人实验样机环境识别信息无线发送(超声或红外测距、机器视觉识别障碍物分布、地面状况等)给计算机控制平台。 The operation flow chart of the bionic legged robot experimental prototype is shown in Figure 5. First, the bionic legged robot experimental prototype is initialized (including system parameter initialization settings, etc.), and then the bionic legged robot experimental prototype wirelessly receives the upper control command signal and gait Data (including gait data, task instructions, etc.), and then conduct the motion experiment of the bionic legged robot experimental prototype, and at the same time wirelessly send the sensory information of the bionic legged robot experimental prototype in real time during the experiment (such as gyroscope, accelerometer, geomagnetic Attitude sensors such as gauges, joint angle and angular velocity sensors, foot force sensors, etc.) and wirelessly send environmental recognition information (ultrasonic or infrared ranging, machine vision recognition of obstacle distribution, ground conditions, etc.) to computer control platform.

如图1所示一种基于Matlab、ADAMS和半实物联合仿真的仿生足式机器人综合仿真策略框图,如按照流程顺序(D→5→A→1→B→2→A),可实现机器人实验样机的运动状态实时运动学演示。具体方式:仿生足式机器人实验样机D无线发送接口机器人环境感知和实时运动反馈数据5到基于Matlab/Simulink仿生足式机器人控制模型A中,基于Matlab/Simulink仿生足式机器人控制模型A传输足端运动轨迹和步态参数1到基于Matlab/SimMechanics仿生足式机器人运动学仿真模型B中,而Matlab/SimMechanics中具有相关的机构运动学动画演示功能,可实时显示机器人实验样机的运动学状态,相关的关节运动轨迹和步态数据2传输到基于Matlab/Simulink仿生足式机器人控制模型A 中,进行运动学数据汇总和保存。 As shown in Figure 1, a bionic legged robot comprehensive simulation strategy block diagram based on Matlab, ADAMS and hardware-in-the-loop co-simulation, such as following the flow sequence (D→5→A→1→B→2→A), the robot experiment can be realized Real-time kinematics demonstration of the motion state of the prototype. Specific method: The experimental prototype D of the bionic footed robot wirelessly sends the interface robot environment perception and real-time motion feedback data 5 to the control model A of the bionic footed robot based on Matlab/Simulink, and the control model A of the bionic footed robot based on Matlab/Simulink transmits the foot end The motion trajectory and gait parameters 1 are transferred to the bionic legged robot kinematics simulation model B based on Matlab/SimMechanics, and Matlab/SimMechanics has the relevant mechanism kinematics animation demonstration function, which can display the kinematics state of the robot experimental prototype in real time. The joint trajectory and gait data 2 of the joints are transferred to the control model A of the bionic legged robot based on Matlab/Simulink, and the kinematics data is summarized and saved.

如图1所示一种基于Matlab、ADAMS和半实物联合仿真的仿生足式机器人综合仿真策略框图,如按照流程顺序(D→5→A→4→C→3→A),可实现机器人实验样机运动状态实时动力学演示。具体方式:仿生足式机器人实验样机D无线发送接口机器人环境感知和实时运动反馈数据5到基于Matlab/Simulink仿生足式机器人控制模型A中,基于Matlab/Simulink仿生足式机器人控制模型A传输运动步态和姿态数据4到基于ADAMS仿生足式机器人动力学模型C中,而ADAMS中具有相关的机构动力学动画演示功能,可实时显示机器人实验样机的动力学数据,相关的动力学联合仿真输出数据3传输到基于Matlab/Simulink仿生足式机器人控制模型A 中,进行动力学数据汇总和保存。 As shown in Figure 1, a bionic footed robot comprehensive simulation strategy block diagram based on Matlab, ADAMS and hardware-in-the-loop co-simulation, such as following the flow sequence (D→5→A→4→C→3→A), the robot experiment can be realized Real-time dynamics demonstration of the motion state of the prototype. Specific method: The experimental prototype D of the bionic legged robot wirelessly sends the interface robot environment perception and real-time motion feedback data 5 to the control model A of the bionic legged robot based on Matlab/Simulink, and the control model A of the bionic legged robot based on Matlab/Simulink transmits the motion steps state and attitude data 4 into the dynamic model C based on ADAMS bionic legged robot, and ADAMS has the relevant mechanism dynamics animation demonstration function, which can display the dynamics data of the robot experimental prototype in real time, and the relevant dynamics co-simulation output data 3 Transfer to the bionic legged robot control model A based on Matlab/Simulink to summarize and save the dynamic data.

如图1所示一种基于Matlab、ADAMS和半实物联合仿真的仿生足式机器人综合仿真策略框图,如按照流程顺序(A→1→B→2→A→4→C→3→A),可实现机器人纯虚拟联合运动仿真。具体方式:基于Matlab/Simulink仿生足式机器人控制模型A传输足端运动轨迹和步态参数1到基于Matlab/SimMechanics仿生足式机器人运动学仿真模型B,经Matlab/SimMechanics仿真后将关节运动轨迹和步态数据2汇总到基于Matlab/Simulink仿生足式机器人控制模型A,基于Matlab/Simulink仿生足式机器人控制模型A将运动步态和姿态数据4发送给基于ADAMS仿生足式机器人动力学模型C,经ADAMS动力学仿真后,将动力学联合仿真输出数据3汇总到基于Matlab/Simulink仿生足式机器人控制模型A,完成了Matlab/SimMechanics和ADAMS的联合运动仿真。 As shown in Figure 1, a comprehensive simulation strategy block diagram of a bionic legged robot based on Matlab, ADAMS and hardware-in-the-loop co-simulation, such as in accordance with the process sequence (A→1→B→2→A→4→C→3→A), It can realize the pure virtual joint motion simulation of the robot. Specific method: Based on the Matlab/Simulink bionic legged robot control model A, transfer the foot end trajectory and gait parameters 1 to the bionic legged robot kinematics simulation model B based on Matlab/SimMechanics, after Matlab/SimMechanics simulation, the joint motion trajectory and The gait data 2 is summarized to the control model A of the bionic footed robot based on Matlab/Simulink, and the motion gait and posture data 4 is sent to the dynamic model C of the bionic footed robot based on ADAMS, based on the Matlab/Simulink bionic footed robot control model A, After the ADAMS dynamics simulation, the dynamics co-simulation output data 3 is summarized to the bionic legged robot control model A based on Matlab/Simulink, and the joint motion simulation of Matlab/SimMechanics and ADAMS is completed.

如图1所示一种基于Matlab、ADAMS和半实物联合仿真的仿生足式机器人综合仿真策略框图,如按照流程顺序(A→1→B→2→A→6→D),可实现机器人步态生成、机器人实验样机的实时运动控制。具体方式:基于Matlab/Simulink仿生足式机器人控制模型A传输足端运动轨迹和步态参数1到基于Matlab/SimMechanics仿生足式机器人运动学仿真模型B,经Matlab/SimMechanics仿真后将关节运动轨迹和步态数据2汇总到基于Matlab/Simulink仿生足式机器人控制模型A,基于Matlab/Simulink仿生足式机器人控制模型A将机器人运动步态数据包和协调控制指令参数6无线发送给仿生足式机器人实验样机D,完成了由Matlab/SimMechanics步态生成后数据实时控制机器人实验样机运动。 As shown in Figure 1, a bionic footed robot comprehensive simulation strategy block diagram based on Matlab, ADAMS and hardware-in-the-loop co-simulation, such as following the flow sequence (A→1→B→2→A→6→D), the robot step can be realized State generation, real-time motion control of robot experimental prototype. Specific method: Based on the Matlab/Simulink bionic legged robot control model A, transfer the foot end trajectory and gait parameters 1 to the bionic legged robot kinematics simulation model B based on Matlab/SimMechanics, after Matlab/SimMechanics simulation, the joint motion trajectory and The gait data 2 is summarized to the bionic footed robot control model A based on Matlab/Simulink, and the robot motion gait data packet and coordination control command parameter 6 are wirelessly sent to the bionic footed robot experiment based on the Matlab/Simulink bionic footed robot control model Prototype D, the data generated by Matlab/SimMechanics gait is used to control the movement of the robot experimental prototype in real time.

如图1所示一种基于Matlab、ADAMS和半实物联合仿真的仿生足式机器人综合仿真策略框图,如按照流程顺序(A→1→B→2→A→4→C→3→A→6→D),可实现机器人步态生成、仿真验证后的机器人实验样机的实时运动控制。具体方式:基于Matlab/Simulink仿生足式机器人控制模型A传输足端运动轨迹和步态参数1到基于Matlab/SimMechanics仿生足式机器人运动学仿真模型B,经Matlab/SimMechanics仿真后将关节运动轨迹和步态数据2汇总到基于Matlab/Simulink仿生足式机器人控制模型A,基于Matlab/Simulink仿生足式机器人控制模型A将运动步态和姿态数据4发送给基于ADAMS仿生足式机器人动力学模型C,经ADAMS动力学仿真后,将动力学联合仿真输出数据3汇总到基于Matlab/Simulink仿生足式机器人控制模型A,完成了Matlab/SimMechanics步态生成和ADAMS的联合运动仿真验证,再将机器人运动步态数据包和协调控制指令参数6无线发送给仿生足式机器人实验样机D,完成了由Matlab/SimMechanics步态生成和ADAMS的联合运动仿真验证后数据实时控制机器人实验样机运动,更准确地实现了机器人实验样机的运动控制。 As shown in Figure 1, a bionic legged robot comprehensive simulation strategy block diagram based on Matlab, ADAMS and hardware-in-the-loop co-simulation, such as in accordance with the flow sequence (A→1→B→2→A→4→C→3→A→6 →D), which can realize the real-time motion control of the robot experimental prototype after robot gait generation and simulation verification. Specific method: Based on the Matlab/Simulink bionic legged robot control model A, transfer the foot end trajectory and gait parameters 1 to the bionic legged robot kinematics simulation model B based on Matlab/SimMechanics, after Matlab/SimMechanics simulation, the joint motion trajectory and The gait data 2 is summarized to the control model A of the bionic footed robot based on Matlab/Simulink, and the motion gait and posture data 4 is sent to the dynamic model C of the bionic footed robot based on ADAMS, based on the Matlab/Simulink bionic footed robot control model A, After the ADAMS dynamics simulation, the dynamics co-simulation output data 3 is summarized to the Matlab/Simulink bionic legged robot control model A, and the Matlab/SimMechanics gait generation and ADAMS joint kinematics simulation verification are completed, and then the robot motion step The state data packet and the coordination control instruction parameter 6 are wirelessly sent to the bionic legged robot experimental prototype D, and the joint motion simulation verification by Matlab/SimMechanics gait generation and ADAMS is completed. Motion control of a robotic experimental prototype.

如图1所示一种基于Matlab、ADAMS和半实物联合仿真的仿生足式机器人综合仿真策略框图,如按照流程顺序(A→1→B→2→A→4→C→3→A∙∙∙→ A→1→B→2→A→4→C→3→A∙∙∙),可实现机器人虚拟联合仿真自学习调整。具体方式:基于Matlab/Simulink仿生足式机器人控制模型A传输足端运动轨迹和步态参数1到基于Matlab/SimMechanics仿生足式机器人运动学仿真模型B,经Matlab/SimMechanics仿真后将关节运动轨迹和步态数据2汇总到基于Matlab/Simulink仿生足式机器人控制模型A,基于Matlab/Simulink仿生足式机器人控制模型A将运动步态和姿态数据4发送给基于ADAMS仿生足式机器人动力学模型C,经ADAMS动力学仿真后,将动力学联合仿真输出数据3汇总到基于Matlab/Simulink仿生足式机器人控制模型A,完成了一次Matlab/SimMechanics和ADAMS的联合运动仿真,通过基于Matlab/Simulink仿生足式机器人控制模型A中自学习模块调整参数,进行连续循环仿真,最终实现虚拟联合仿真自学习调整,为数据优化和自适应控制提供依据。 As shown in Figure 1, a bionic footed robot comprehensive simulation strategy block diagram based on Matlab, ADAMS and hardware-in-the-loop co-simulation, such as in accordance with the process sequence (A→1→B→2→A→4→C→3→A∙∙ ∙→A→1→B→2→A→4→C→3→A∙∙∙), which can realize the self-learning adjustment of robot virtual co-simulation. Specific method: Based on the Matlab/Simulink bionic legged robot control model A, transfer the foot end trajectory and gait parameters 1 to the bionic legged robot kinematics simulation model B based on Matlab/SimMechanics, after Matlab/SimMechanics simulation, the joint motion trajectory and The gait data 2 is summarized to the control model A of the bionic footed robot based on Matlab/Simulink, and the motion gait and posture data 4 is sent to the dynamic model C of the bionic footed robot based on ADAMS, based on the Matlab/Simulink bionic footed robot control model A, After the ADAMS dynamics simulation, the dynamics co-simulation output data 3 was summarized to the control model A of the bionic legged robot based on Matlab/Simulink, and a joint motion simulation of Matlab/SimMechanics and ADAMS was completed, and the bionic legged robot based on Matlab/Simulink The self-learning module in the robot control model A adjusts the parameters, performs continuous cycle simulation, and finally realizes the virtual co-simulation self-learning adjustment, which provides a basis for data optimization and adaptive control.

如图1所示一种基于Matlab、ADAMS和半实物联合仿真的仿生足式机器人综合仿真策略框图,如按照流程顺序(A→1→B→2→A→6→D→5→A∙∙∙→ A→1→B→2→A→6→D→5→A∙∙∙),可实现机器人半实物仿真自学习调整。具体方式:基于Matlab/Simulink仿生足式机器人控制模型A传输足端运动轨迹和步态参数1到基于Matlab/SimMechanics仿生足式机器人运动学仿真模型B,经Matlab/SimMechanics仿真后将关节运动轨迹和步态数据2汇总到基于Matlab/Simulink仿生足式机器人控制模型A,基于Matlab/Simulink仿生足式机器人控制模型A将机器人运动步态数据包和协调控制指令参数6发送给仿生足式机器人实验样机D,经机器人实验样机运动实验后,将机器人环境感知和实时运动反馈数据5汇总到基于Matlab/Simulink仿生足式机器人控制模型A,完成了一次Matlab/SimMechanics和半实物实验样机的联合运动仿真,通过基于Matlab/Simulink仿生足式机器人控制模型A中自学习模块调整参数,进行连续循环半实物仿真,最终实现半实物联合仿真下的自学习调整,为数据优化和自适应控制提供依据。 As shown in Figure 1, a bionic footed robot comprehensive simulation strategy block diagram based on Matlab, ADAMS and hardware-in-the-loop co-simulation, such as in accordance with the process sequence (A→1→B→2→A→6→D→5→A∙∙ ∙→A→1→B→2→A→6→D→5→A∙∙∙), which can realize the self-learning adjustment of the robot half-in-the-loop simulation. Specific method: Based on the Matlab/Simulink bionic legged robot control model A, transfer the foot end trajectory and gait parameters 1 to the bionic legged robot kinematics simulation model B based on Matlab/SimMechanics, after Matlab/SimMechanics simulation, the joint motion trajectory and The gait data 2 is summarized to the bionic legged robot control model A based on Matlab/Simulink, and the robot motion gait data package and coordination control instruction parameter 6 are sent to the bionic legged robot experimental prototype based on the Matlab/Simulink bionic legged robot control model A D. After the motion experiment of the robot experimental prototype, the robot environment perception and real-time motion feedback data 5 were summarized into the Matlab/Simulink-based bionic legged robot control model A, and a joint motion simulation of Matlab/SimMechanics and the semi-physical experimental prototype was completed. By adjusting the parameters of the self-learning module based on the Matlab/Simulink bionic legged robot control model A, the continuous loop hardware-in-the-loop simulation is carried out, and finally the self-learning adjustment under the hardware-in-the-loop joint simulation is realized, which provides a basis for data optimization and adaptive control.

如图1所示一种基于Matlab、ADAMS和半实物联合仿真的仿生足式机器人综合仿真策略框图,如按照流程顺序((A→1→B→2→A→4→C→3)+(A→6→D→5)→A ∙∙∙→(A→1→B→2→A→4→C→3)+(A→6→D→5)→A ∙∙∙),可实现机器人自适应多协调控制。具体方式:基于Matlab/Simulink仿生足式机器人控制模型A传输足端运动轨迹和步态参数1到基于Matlab/SimMechanics仿生足式机器人运动学仿真模型B,经Matlab/SimMechanics仿真后将关节运动轨迹和步态数据2汇总到基于Matlab/Simulink仿生足式机器人控制模型A,基于Matlab/Simulink仿生足式机器人控制模型A将运动步态和姿态数据4发送给基于ADAMS仿生足式机器人动力学模型C,经ADAMS动力学仿真后,将动力学联合仿真输出数据3汇总到基于Matlab/Simulink仿生足式机器人控制模型A。在此同时,基于Matlab/Simulink仿生足式机器人控制模型A,将机器人运动步态数据包和协调控制指令参数6发送给仿生足式机器人实验样机D,经机器人实验样机运动实验后,将机器人环境感知和实时运动反馈数据5汇总到基于Matlab/Simulink仿生足式机器人控制模型A。整合动力学联合仿真输出数据3和实时运动反馈数据5,两者数据进行互补和自学习调控,完成了在实际机器人样机缺失部分传感信息的条件下,借助仿真数据实现机器人自适应多协调控制。 As shown in Figure 1, a comprehensive simulation strategy block diagram of a bionic legged robot based on Matlab, ADAMS and hardware-in-the-loop co-simulation, for example, according to the process sequence ((A→1→B→2→A→4→C→3)+( A→6→D→5)→A ∙∙∙→(A→1→B→2→A→4→C→3)+(A→6→D→5)→A ∙∙∙), achievable Adaptive multi-coordination control for robots. Specific method: Based on the Matlab/Simulink bionic legged robot control model A, transfer the foot end trajectory and gait parameters 1 to the bionic legged robot kinematics simulation model B based on Matlab/SimMechanics, after Matlab/SimMechanics simulation, the joint motion trajectory and The gait data 2 is summarized to the control model A of the bionic footed robot based on Matlab/Simulink, and the motion gait and posture data 4 is sent to the dynamic model C of the bionic footed robot based on ADAMS, based on the Matlab/Simulink bionic footed robot control model A, After the ADAMS dynamics simulation, the dynamics co-simulation output data 3 is summarized to the control model A of the bionic legged robot based on Matlab/Simulink. At the same time, based on the Matlab/Simulink bionic legged robot control model A, the robot motion gait data packet and the coordination control instruction parameter 6 are sent to the bionic legged robot experimental prototype D. After the robot experimental prototype motion experiment, the robot environment The perception and real-time motion feedback data 5 are summarized into the control model A of the bionic legged robot based on Matlab/Simulink. Integrating dynamics co-simulation output data 3 and real-time motion feedback data 5, the two data are complemented and self-learning control, and the robot adaptive multi-coordination control is realized with the help of simulation data under the condition that the actual robot prototype lacks part of the sensor information .

Claims (5)

1.一种基于Matlab、ADAMS和半实物联合仿真的仿生足式机器人综合仿真策略,其特征在于: 1. a kind of bionic legged robot comprehensive simulation strategy based on Matlab, ADAMS and hardware-in-the-loop co-simulation, is characterized in that: 所用系统包括:基于Matlab/Simulink仿生足式机器人控制模型(A)、基于Matlab/SimMechanics仿生足式机器人运动学仿真模型(B)、基于ADAMS仿生足式机器人动力学模型(C)、仿生足式机器人实验样机(D); The system used includes: Matlab/Simulink-based bionic footed robot control model (A), based on Matlab/SimMechanics bionic footed robot kinematics simulation model (B), ADAMS-based bionic footed robot dynamics model (C), bionic footed robot Robot experimental prototype (D); 所述策略包括机器人实验样机的运动状态实时运动学演示过程,具体方式:仿生足式机器人实验样机(D)无线发送接口机器人环境感知和实时运动反馈数据(5)到基于Matlab/Simulink仿生足式机器人控制模型(A)中,基于Matlab/Simulink仿生足式机器人控制模型(A)传输足端运动轨迹和步态参数(1)到基于Matlab/SimMechanics仿生足式机器人运动学仿真模型(B)中,而Matlab/SimMechanics中具有相关的机构运动学动画演示功能,实时显示机器人实验样机的运动学状态,相关的关节运动轨迹和步态数据(2)传输到基于Matlab/Simulink仿生足式机器人控制模型(A)中,进行运动学数据汇总和保存; The strategy includes the real-time kinematics demonstration process of the motion state of the robot experimental prototype, in a specific way: the bionic legged robot experimental prototype (D) wirelessly sends interface robot environment perception and real-time motion feedback data (5) to the bionic legged model based on Matlab/Simulink In the robot control model (A), the bionic legged robot control model (A) based on Matlab/Simulink transfers the foot end trajectory and gait parameters (1) to the bionic legged robot kinematics simulation model (B) based on Matlab/SimMechanics , while Matlab/SimMechanics has the relevant mechanism kinematics animation demonstration function, real-time display of the kinematics state of the robot experimental prototype, the relevant joint motion trajectory and gait data (2) transmitted to the bionic legged robot control model based on Matlab/Simulink In (A), the kinematics data is summarized and saved; 所述策略包括机器人实验样机运动状态实时动力学演示过程,具体方式:仿生足式机器人实验样机(D)无线发送接口机器人环境感知和实时运动反馈数据(5)到基于Matlab/Simulink仿生足式机器人控制模型(A)中,基于Matlab/Simulink仿生足式机器人控制模型(A)传输运动步态和姿态数据(4)传输到基于ADAMS仿生足式机器人动力学模型(C)中,而ADAMS中具有相关的机构动力学动画演示功能,可实时显示机器人实验样机的动力学数据,相关的动力学联合仿真输出数据(3)到基于Matlab/Simulink仿生足式机器人控制模型(A)中,进行动力学数据汇总和保存; The strategy includes the real-time dynamics demonstration process of the motion state of the experimental prototype of the robot. The specific method is: the experimental prototype of the bionic legged robot (D) wirelessly sends the interface robot environment perception and real-time motion feedback data (5) to the bionic legged robot based on Matlab/Simulink In the control model (A), the control model (A) based on Matlab/Simulink bionic legged robot transfers motion gait and attitude data (4) to the bionic legged robot dynamic model (C) based on ADAMS, and ADAMS has The relevant mechanism dynamics animation demonstration function can display the dynamics data of the robot experimental prototype in real time, and the relevant dynamics co-simulation output data (3) is transferred to the bionic footed robot control model (A) based on Matlab/Simulink for dynamics analysis. data aggregation and storage; 所述策略包括机器人纯虚拟联合运动仿真过程,具体方式:基于Matlab/Simulink仿生足式机器人控制模型(A)传输足端运动轨迹和步态参数(1)到基于Matlab/SimMechanics仿生足式机器人运动学仿真模型(B),经Matlab/SimMechanics仿真后将关节运动轨迹和步态数据(2)汇总到基于Matlab/Simulink仿生足式机器人控制模型(A),基于Matlab/Simulink仿生足式机器人控制模型(A)将运动步态和姿态数据(4)发送给基于ADAMS仿生足式机器人动力学模型(C),经ADAMS动力学仿真后,将动力学联合仿真输出数据(3)汇总到基于Matlab/Simulink仿生足式机器人控制模型(A),完成了Matlab/SimMechanics和ADAMS的联合运动仿真; The strategy includes the pure virtual joint motion simulation process of the robot. The specific method is: based on the Matlab/Simulink bionic footed robot control model (A), the foot end motion trajectory and gait parameters (1) are transferred to the bionic footed robot based on Matlab/SimMechanics. Learning simulation model (B), after Matlab/SimMechanics simulation, the joint trajectory and gait data (2) are summarized into the control model of bionic footed robot based on Matlab/Simulink (A), and the control model of bionic footed robot based on Matlab/Simulink (A) Send the motion gait and attitude data (4) to the ADAMS-based bionic legged robot dynamics model (C), after the ADAMS dynamics simulation, the dynamics co-simulation output data (3) is summarized to the Matlab/ Simulink bionic legged robot control model (A), completed the joint motion simulation of Matlab/SimMechanics and ADAMS; 所述策略包括机器人步态生成、机器人实验样机的实时运动控制过程,具体方式:基于Matlab/Simulink仿生足式机器人控制模型(A)传输足端运动轨迹和步态参数(1)到基于Matlab/SimMechanics仿生足式机器人运动学仿真模型(B),经Matlab/SimMechanics仿真后将关节运动轨迹和步态数据(2)汇总到基于Matlab/Simulink仿生足式机器人控制模型(A),基于Matlab/Simulink仿生足式机器人控制模型(A)将机器人运动步态数据包和协调控制指令参数(6)无线发送给仿生足式机器人实验样机(D),完成了由Matlab/SimMechanics步态生成后数据实时控制机器人实验样机运动; The strategy includes robot gait generation, the real-time motion control process of the robot experimental prototype, in a specific way: based on Matlab/Simulink bionic legged robot control model (A) transmission foot end motion trajectory and gait parameters (1) to the Matlab/Simulink based SimMechanics bionic legged robot kinematics simulation model (B), after Matlab/SimMechanics simulation, the joint trajectory and gait data (2) are summarized into the bionic legged robot control model based on Matlab/Simulink (A), based on Matlab/Simulink The bionic legged robot control model (A) wirelessly sends the robot motion gait data packet and the coordination control instruction parameters (6) to the bionic legged robot experimental prototype (D), and completes the real-time control of the data generated by Matlab/SimMechanics gait Robot experiment prototype movement; 所述策略包括机器人步态生成、仿真验证后的机器人实验样机的实时运动控制过程,具体方式:基于Matlab/Simulink仿生足式机器人控制模型(A)传输足端运动轨迹和步态参数(1)到基于Matlab/SimMechanics仿生足式机器人运动学仿真模型(B),经Matlab/SimMechanics仿真后将关节运动轨迹和步态数据(2)汇总到基于Matlab/Simulink仿生足式机器人控制模型(A),基于Matlab/Simulink仿生足式机器人控制模型(A)将运动步态和姿态数据(4)发送给基于ADAMS仿生足式机器人动力学模型(C),经ADAMS动力学仿真后,将动力学联合仿真输出数据(3)汇总到基于Matlab/Simulink仿生足式机器人控制模型(A),完成了Matlab/SimMechanics步态生成和ADAMS的联合运动仿真验证,再将机器人运动步态数据包和协调控制指令参数(6)无线发送给仿生足式机器人实验样机(D),完成了由Matlab/SimMechanics步态生成和ADAMS的联合运动仿真验证后数据实时控制机器人实验样机运动,更准确地实现了机器人实验样机的运动控制; The strategy includes robot gait generation, real-time motion control process of the robot experimental prototype after simulation verification, specific method: based on Matlab/Simulink bionic footed robot control model (A) transmission of foot end motion trajectory and gait parameters (1) To the bionic legged robot kinematics simulation model (B) based on Matlab/SimMechanics, after Matlab/SimMechanics simulation, the joint trajectory and gait data (2) are summarized to the bionic legged robot control model (A) based on Matlab/Simulink, Based on the Matlab/Simulink bionic footed robot control model (A), the motion gait and attitude data (4) are sent to the ADAMS-based bionic footed robot dynamic model (C). After the ADAMS dynamics simulation, the dynamics joint simulation The output data (3) is summarized into the control model (A) of the bionic footed robot based on Matlab/Simulink, and the joint motion simulation verification of Matlab/SimMechanics gait generation and ADAMS is completed, and then the robot motion gait data package and coordination control command parameters (6) Send wirelessly to the bionic legged robot experimental prototype (D), complete the joint motion simulation verification by Matlab/SimMechanics gait generation and ADAMS, and control the movement of the robot experimental prototype in real time, more accurately realizing the robot experimental prototype sport control; 所述策略包括机器人虚拟联合仿真自学习调整过程,具体方式:基于Matlab/Simulink仿生足式机器人控制模型(A)传输足端运动轨迹和步态参数(1)到基于Matlab/SimMechanics仿生足式机器人运动学仿真模型(B),经Matlab/SimMechanics仿真后将关节运动轨迹和步态数据(2)汇总到基于Matlab/Simulink仿生足式机器人控制模型(A),基于Matlab/Simulink仿生足式机器人控制模型(A)将运动步态和姿态数据(4)发送给基于ADAMS仿生足式机器人动力学模型(C),经ADAMS动力学仿真后,将动力学联合仿真输出数据(3)汇总到基于Matlab/Simulink仿生足式机器人控制模型(A),完成了一次Matlab/SimMechanics和ADAMS的联合运动仿真,通过基于Matlab/Simulink仿生足式机器人控制模型(A)中自学习模块调整参数,进行连续循环仿真,最终实现虚拟联合仿真自学习调整,为数据优化和自适应控制提供依据; The strategy includes the robot virtual co-simulation self-learning adjustment process, the specific way: based on the Matlab/Simulink bionic legged robot control model (A) transfer foot end motion trajectory and gait parameters (1) to the Matlab/SimMechanics bionic legged robot Kinematics simulation model (B), after Matlab/SimMechanics simulation, the joint trajectory and gait data (2) are summarized into the control model of the bionic footed robot based on Matlab/Simulink (A), based on the control of the bionic footed robot based on Matlab/Simulink The model (A) sends the motion gait and attitude data (4) to the ADAMS-based bionic legged robot dynamics model (C). After the ADAMS dynamics simulation, the dynamics co-simulation output data (3) is summarized to the /Simulink bionic footed robot control model (A), completed a joint motion simulation of Matlab/SimMechanics and ADAMS, and performed continuous cycle simulation by adjusting parameters based on the self-learning module in the Matlab/Simulink bionic footed robot control model (A) , and finally realize the self-learning adjustment of virtual co-simulation, providing a basis for data optimization and adaptive control; 所述策略包括机器人半实物仿真自学习调整过程,具体方式:基于Matlab/Simulink仿生足式机器人控制模型(A)传输足端运动轨迹和步态参数(1)到基于Matlab/SimMechanics仿生足式机器人运动学仿真模型(B),经Matlab/SimMechanics仿真后将关节运动轨迹和步态数据(2)汇总到基于Matlab/Simulink仿生足式机器人控制模型(A),基于Matlab/Simulink仿生足式机器人控制模型(A)将机器人运动步态数据包和协调控制指令参数(6)发送给仿生足式机器人实验样机(D),经机器人实验样机运动实验后,将机器人环境感知和实时运动反馈数据(5)汇总到基于Matlab/Simulink仿生足式机器人控制模型(A),完成了一次Matlab/SimMechanics和半实物实验样机的联合运动仿真,通过基于Matlab/Simulink仿生足式机器人控制模型(A)中自学习模块调整参数,进行连续循环半实物仿真,最终实现半实物联合仿真下的自学习调整,为数据优化和自适应控制提供依据; The strategy includes the robot hardware-in-the-loop simulation self-learning adjustment process, the specific way: based on Matlab/Simulink bionic legged robot control model (A) transfer foot end motion trajectory and gait parameters (1) to the bionic legged robot based on Matlab/SimMechanics Kinematics simulation model (B), after Matlab/SimMechanics simulation, the joint trajectory and gait data (2) are summarized into the control model of the bionic footed robot based on Matlab/Simulink (A), based on the control of the bionic footed robot based on Matlab/Simulink Model (A) sends the robot motion gait data packet and coordination control instruction parameters (6) to the bionic legged robot experimental prototype (D), after the robot experimental prototype motion experiment, the robot environment perception and real-time motion feedback data (5 ) to the control model (A) of the bionic footed robot based on Matlab/Simulink, and completed a joint motion simulation of Matlab/SimMechanics and the half-in-the-loop experimental prototype. The module adjusts the parameters, performs continuous loop hardware-in-the-loop simulation, and finally realizes the self-learning adjustment under the hardware-in-the-loop joint simulation, providing a basis for data optimization and adaptive control; 所述策略包括机器人自适应多协调控制过程,具体方式:基于Matlab/Simulink仿生足式机器人控制模型(A)传输足端运动轨迹和步态参数(1)到基于Matlab/SimMechanics仿生足式机器人运动学仿真模型(B),经Matlab/SimMechanics仿真后将关节运动轨迹和步态数据(2)汇总到基于Matlab/Simulink仿生足式机器人控制模型(A),基于Matlab/Simulink仿生足式机器人控制模型(A)将运动步态和姿态数据(4)发送给基于ADAMS仿生足式机器人动力学模型(C),经ADAMS动力学仿真后,将动力学联合仿真输出数据(3)汇总到基于Matlab/Simulink仿生足式机器人控制模型(A);在此同时,基于Matlab/Simulink仿生足式机器人控制模型(A),将机器人运动步态数据包和协调控制指令参数(6)发送给仿生足式机器人实验样机(D),经机器人实验样机运动实验后,将机器人环境感知和实时运动反馈数据(5)汇总到基于Matlab/Simulink仿生足式机器人控制模型(A);整合动力学联合仿真输出数据(3)和实时运动反馈数据,两者数据进行互补和自学习调控,完成了在实际机器人样机缺失部分传感信息的条件下,借助仿真数据实现机器人自适应多协调控制。 The strategy includes the robot self-adaptive multi-coordination control process, the specific way: based on the Matlab/Simulink bionic legged robot control model (A) transfer foot end motion track and gait parameters (1) to the bionic legged robot motion based on Matlab/SimMechanics Learning simulation model (B), after Matlab/SimMechanics simulation, the joint trajectory and gait data (2) are summarized into the control model of bionic footed robot based on Matlab/Simulink (A), and the control model of bionic footed robot based on Matlab/Simulink (A) Send the motion gait and attitude data (4) to the ADAMS-based bionic legged robot dynamics model (C), after the ADAMS dynamics simulation, the dynamics co-simulation output data (3) is summarized to the Matlab/ Simulink bionic legged robot control model (A); at the same time, based on Matlab/Simulink bionic legged robot control model (A), the robot motion gait data packet and coordination control command parameters (6) are sent to the bionic legged robot Experimental prototype (D), after the motion experiment of the robot experimental prototype, the robot environment perception and real-time motion feedback data (5) are summarized into the Matlab/Simulink-based bionic legged robot control model (A); the output data of the integrated dynamics co-simulation ( 3) and real-time motion feedback data, the two data are complementary and self-learning regulation, and the robot adaptive multi-coordination control is realized with the help of simulation data under the condition that the actual robot prototype lacks part of the sensing information. 2.根据权利要求1所述的基于Matlab、ADAMS和半实物联合仿真的仿生足式机器人综合仿真策略,其特征在于:所述的基于Matlab/Simulink仿生足式机器人控制模型(A)搭建方式,具体方式:首先在Matlab/Simulink仿生足式机器人仿真系统中设置如系统内部仿真算法类型、周期、步长、误差范围的参数,接着根据实现机器人调试所需选择性地建立基于Matlab/Simulink的仿生足式机器人运动演示模块、建立基于Matlab/Simulink的仿生足式机器人运动步态控制模块、建立基于Matlab/Simulink的仿生足式机器人运动自学习模块和建立基于Matlab/Simulink的仿生足式机器人协调控制模块,最后连接Matlab/Simulink仿生足式机器人仿真系统接口,进行数据交换,协调数据处理。 2. the comprehensive simulation strategy of the bionic legged robot based on Matlab, ADAMS and half-in-the-loop co-simulation according to claim 1, is characterized in that: described based on Matlab/Simulink bionic legged robot control model (A) construction mode, Specific method: first set parameters such as system internal simulation algorithm type, period, step size, and error range in the Matlab/Simulink bionic legged robot simulation system, and then selectively establish a Matlab/Simulink-based bionic simulation system according to the needs of robot debugging. Footed robot motion demonstration module, establishment of bionic footed robot motion gait control module based on Matlab/Simulink, establishment of bionic footed robot motion self-learning module based on Matlab/Simulink, and establishment of bionic footed robot coordination control based on Matlab/Simulink The module is finally connected to the Matlab/Simulink bionic legged robot simulation system interface for data exchange and coordination of data processing. 3.根据权利要求1所述的基于Matlab、ADAMS和半实物联合仿真的仿生足式机器人综合仿真策略,其特征在于:所述的基于Matlab/SimMechanics仿生足式机器人运动学仿真模型(B)搭建方式,具体方式:首先创建Matlab/SimMechanics仿生足式机器人运动学仿真环境,设定系统环境参数,接着在Matlab/SimMechanics中建立仿生足式机器人系统世界坐标系和各腿运动关节的自由度数及方向,设置包括质量、惯量、长度的各腿杆件刚体参数、关节控制器类型、关节传感器输出类型,最后根据机器人运动控制要求,引出Matlab/SimMechanics仿生足式机器人运动学仿真模型中的输入和输出接口,准备接受关节输入数据和发送关节输出数据,进行数据交换,实现运动学运算功能。 3. the bionic legged robot comprehensive simulation strategy based on Matlab, ADAMS and half-in-the-loop co-simulation according to claim 1, is characterized in that: described based on Matlab/SimMechanics bionic legged robot kinematics simulation model (B) builds Method, specific method: first create the Matlab/SimMechanics bionic footed robot kinematics simulation environment, set the system environment parameters, and then establish the bionic footed robot system world coordinate system and the degrees of freedom and directions of the kinematic joints of each leg in Matlab/SimMechanics , set the rigid body parameters of each leg member including mass, inertia, length, joint controller type, joint sensor output type, and finally, according to the robot motion control requirements, lead to the input and output of the Matlab/SimMechanics bionic legged robot kinematics simulation model The interface is ready to accept joint input data and send joint output data for data exchange to realize kinematic calculation functions. 4.根据权利要求1所述的基于Matlab、ADAMS和半实物联合仿真的仿生足式机器人综合仿真策略,其特征在于:所述的基于ADAMS仿生足式机器人动力学模型(C)搭建方式,具体方式:首先创建ADAMS仿生足式机器人动力学仿真环境,设定系统环境参数,接着在ADAMS中导入地面刚体、仿生足式机器人各腿杆件刚体,设定刚体几何尺寸、材料类型或密度或质量参数,然后在ADAMS中设定各刚体之间关节自由度数及关节类型,并在ADAMS中设定各足端与地面刚体之间碰撞类型、摩擦约束及相关参数设定,最后根据实际要求,设定ADAMS仿生足式机器人运动学仿真模型中的输入和输出接口,准备接受关节输入数据、发送关节输出数据和足端碰撞力数据,进行数据交换,实现动力学运算功能。 4. the comprehensive simulation strategy of the bionic footed robot based on Matlab, ADAMS and half-in-the-loop co-simulation according to claim 1, is characterized in that: described based on ADAMS bionic footed robot dynamics model (C) construction mode, specifically Method: First create the dynamics simulation environment of the ADAMS bionic footed robot, set the system environment parameters, then import the ground rigid body and the rigid body of each leg of the bionic footed robot into ADAMS, and set the geometric size, material type or density or quality of the rigid body parameters, and then set the joint degrees of freedom and joint types between each rigid body in ADAMS, and set the collision type between each foot end and the ground rigid body, friction constraints and related parameter settings in ADAMS, and finally according to actual requirements, set Define the input and output interfaces in the ADAMS bionic legged robot kinematics simulation model, prepare to receive joint input data, send joint output data and foot end collision force data, exchange data, and realize dynamic calculation functions. 5.根据权利要求1所述的基于Matlab、ADAMS和半实物联合仿真的仿生足式机器人综合仿真策略,其特征在于:所述的仿生足式机器人实验样机(D)操作流程,具体方式:首先仿生足式机器人实验样机(D)进行初始化,设定包括系统初始化参数,接着仿生足式机器人实验样机(D)无线接收上层任务控制指令信号和步态数据,然后进行仿生足式机器人实验样机(D)运动实验,同时把实验过程中实时将仿生足式机器人实验样机(D)自身感知的姿态传感、关节角度、角速度、足端力信息和仿生足式机器人实验样机(D)环境识别的红外测距、机器视觉识别障碍物分布、地面状况信息无线发送给计算机控制平台。 5. the comprehensive simulation strategy of the bionic legged robot based on Matlab, ADAMS and half-in-the-loop co-simulation according to claim 1, is characterized in that: described bionic legged robot experimental prototype (D) operation process, concrete mode: first The bionic legged robot experimental prototype (D) is initialized, setting includes system initialization parameters, then the bionic legged robot experimental prototype (D) wirelessly receives the upper task control command signal and gait data, and then performs the bionic legged robot experimental prototype ( D) Motion experiment, at the same time, the attitude sensing, joint angle, angular velocity, foot end force information and the environment recognition of the bionic footed robot experimental prototype (D) are collected in real time during the experiment. Infrared ranging, machine vision recognition of obstacle distribution, and ground condition information are sent wirelessly to the computer control platform.
CN201410064577.9A 2014-02-26 2014-02-26 Bionic foot-type robot comprehensive simulation method Expired - Fee Related CN103832504B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201410064577.9A CN103832504B (en) 2014-02-26 2014-02-26 Bionic foot-type robot comprehensive simulation method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201410064577.9A CN103832504B (en) 2014-02-26 2014-02-26 Bionic foot-type robot comprehensive simulation method

Publications (2)

Publication Number Publication Date
CN103832504A true CN103832504A (en) 2014-06-04
CN103832504B CN103832504B (en) 2017-01-25

Family

ID=50796480

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201410064577.9A Expired - Fee Related CN103832504B (en) 2014-02-26 2014-02-26 Bionic foot-type robot comprehensive simulation method

Country Status (1)

Country Link
CN (1) CN103832504B (en)

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104950689A (en) * 2015-04-13 2015-09-30 哈尔滨工业大学深圳研究生院 Robot actor simulation system for robot dramas
CN105654836A (en) * 2016-02-01 2016-06-08 北京理工大学 Comprehensive simulation method for spherical robot based on SolidWorks and ADAMS environment
CN107283386A (en) * 2017-05-27 2017-10-24 江苏物联网研究发展中心 Man-machine synchronous method
CN107290957A (en) * 2016-03-31 2017-10-24 深圳光启合众科技有限公司 Smart machine and its optimization method and equipment
CN109086466A (en) * 2017-06-14 2018-12-25 深圳市祈飞科技有限公司 Single leg multiaxis biped robot kinematics joint simulation method
CN109726511A (en) * 2019-01-23 2019-05-07 广西大学 Determination method of joint angle of gait rehabilitation robot based on UG and ADAMS
CN111381514A (en) * 2018-12-29 2020-07-07 沈阳新松机器人自动化股份有限公司 Robot testing system and method based on semi-physical simulation technology
CN113705049A (en) * 2021-08-26 2021-11-26 哈尔滨工业大学 Soft robot dynamics simulation method
CN114932961A (en) * 2022-06-15 2022-08-23 中电海康集团有限公司 Four-footed robot motion control system

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1289665A (en) * 1999-09-07 2001-04-04 索尼公司 Robot and joint unit
EP1118436A1 (en) * 1999-04-05 2001-07-25 Sony Corporation Robot, servo circuit, actuator, robot control method, and actuator control method
WO2002081157A1 (en) * 2001-04-03 2002-10-17 Sony Corporation Legged mobile robot and its motion teaching method, and storage medium
US20050240308A1 (en) * 2002-05-07 2005-10-27 Nat Institute Of Advance Indust Science & Tech. Method and device for controlling walking of legged robot
KR100695355B1 (en) * 1999-11-24 2007-03-19 소니 가부시끼 가이샤 Walking control method of walking robot and walking robot
CN102431033A (en) * 2010-08-31 2012-05-02 株式会社安川电机 Robot, robot system, robot control device, and state determining method

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP1118436A1 (en) * 1999-04-05 2001-07-25 Sony Corporation Robot, servo circuit, actuator, robot control method, and actuator control method
CN1289665A (en) * 1999-09-07 2001-04-04 索尼公司 Robot and joint unit
KR100695355B1 (en) * 1999-11-24 2007-03-19 소니 가부시끼 가이샤 Walking control method of walking robot and walking robot
WO2002081157A1 (en) * 2001-04-03 2002-10-17 Sony Corporation Legged mobile robot and its motion teaching method, and storage medium
US20050240308A1 (en) * 2002-05-07 2005-10-27 Nat Institute Of Advance Indust Science & Tech. Method and device for controlling walking of legged robot
CN102431033A (en) * 2010-08-31 2012-05-02 株式会社安川电机 Robot, robot system, robot control device, and state determining method

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
刘蕊,俞志伟 等: "仿生四足机器人对角步态规划及稳定性分析", 《科学技术与工程》 *
庄明,俞志伟 等: "基于ADAMS的液压驱动四足机器人步态规划与仿真", 《机械设计与制造》 *
阮鹏,俞志伟 等: "基于ADAMS 的仿壁虎机器人步态规划及仿真", 《机器人》 *

Cited By (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104950689A (en) * 2015-04-13 2015-09-30 哈尔滨工业大学深圳研究生院 Robot actor simulation system for robot dramas
CN105654836A (en) * 2016-02-01 2016-06-08 北京理工大学 Comprehensive simulation method for spherical robot based on SolidWorks and ADAMS environment
CN105654836B (en) * 2016-02-01 2018-03-16 北京理工大学 Ball shape robot comprehensive simulating method based on SolidWorks, ADAMS environment
CN107290957A (en) * 2016-03-31 2017-10-24 深圳光启合众科技有限公司 Smart machine and its optimization method and equipment
CN107283386A (en) * 2017-05-27 2017-10-24 江苏物联网研究发展中心 Man-machine synchronous method
CN109086466A (en) * 2017-06-14 2018-12-25 深圳市祈飞科技有限公司 Single leg multiaxis biped robot kinematics joint simulation method
CN111381514A (en) * 2018-12-29 2020-07-07 沈阳新松机器人自动化股份有限公司 Robot testing system and method based on semi-physical simulation technology
CN109726511A (en) * 2019-01-23 2019-05-07 广西大学 Determination method of joint angle of gait rehabilitation robot based on UG and ADAMS
CN109726511B (en) * 2019-01-23 2022-10-28 广西大学 Determination method of joint angle of gait rehabilitation robot based on UG and ADAMS
CN113705049A (en) * 2021-08-26 2021-11-26 哈尔滨工业大学 Soft robot dynamics simulation method
CN114932961A (en) * 2022-06-15 2022-08-23 中电海康集团有限公司 Four-footed robot motion control system
CN114932961B (en) * 2022-06-15 2023-10-10 中电海康集团有限公司 Motion control system of four-foot robot

Also Published As

Publication number Publication date
CN103832504B (en) 2017-01-25

Similar Documents

Publication Publication Date Title
CN103832504B (en) Bionic foot-type robot comprehensive simulation method
CN105904461B (en) A kind of adaptive remote operating control method of neutral net based on RBF
CN108058758B (en) Robot biped walking simulation evaluation system and evaluation method based on six-degree-of-freedom leg
CN103901889A (en) Multi-robot formation control path tracking method based on Bluetooth communications
CN107457762A (en) Robot arm control device, robot arm system including the same, and robot arm control method
CN105404744B (en) A kind of space manipulator total state dynamics semi-physical system
CN104267614A (en) Unmanned aerial vehicle real-time simulation system and developing method thereof
CN104573255A (en) Mechanical arm modeling and solving method based on improvement of multi-body system transfer matrix
Liu et al. An articulated closed kinematic chain planar robotic leg for high-speed locomotion
CN115252369B (en) Auxiliary control method based on lower limb exoskeleton robot as required
CN109159120B (en) Active control method and system based on current feedback of rehabilitation manipulator joint motor
CN112045664A (en) General mechanical arm controller based on ROS system
Pan et al. Dynamics modeling of spraying robot using Lagrangian method with co-simulation analysis
Feng et al. ROS-based humanoid robot pose control system design
CN115416017B (en) Method for constructing electrohydraulic control sense simulation platform of hydraulic quadruped robot
Vlădăreanu et al. Complex walking robot kinematics analysis and PLC multi-tasking control
Lee et al. Development and motion control of a biped walking robot based on passive walking theory
Ma et al. A mathematical model including mechanical structure, hydraulic and control of LHDS
Ha et al. Wireless-communicated computed-torque control of a SCARA robot and two-dimensional input shaping for a spherical pendulum
Asif et al. Design and simulation of a biologically inspired hexapod robot using simmechanics
CN107562968B (en) Hybrid calculation method for kinetic modeling of foot type robot
CN104950689A (en) Robot actor simulation system for robot dramas
Dou et al. Research on the Virtual–real Interaction System and Interaction Characteristics of a Single-leg of Quadruped Robots Based on Digital Twin
Zang et al. Control strategy research for a biped walking robot with flexible ankle joints
Liu et al. Path planning and system simulation for an industrial spot welding robot based on SimMechanics

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20170125