一种仿蛇搜救机器人多步态控制方法技术

本发明专利技术涉及一种仿蛇搜救机器人多步态控制方法，针对自然、轮式和混沌运动步态，利用反馈神经网络Hopfield Neural Network(HNN)的输出和三类运动步态所需输入一致性关系，通过调整HNN权重参数获得相应的步态信号，然后将HNN的输出信号作为仿蛇搜救机器人动力学控制器的输入信号，控制仿蛇搜救机器人产生相应步态。在非稳定状态时，即初始时刻和步态转换时刻，利用Motion Shape Code Technique(MSCT)产生相应步态的初始形状并将直线形状作为中间过程状态进行步态转换。本发明专利技术解决传统Central Pattern Generator(CPG)方法在步态控制时未考虑非周期步态和混沌步态问题，更切合实际，能够使仿蛇搜救机器人更好地应用在搜救任务中。

【技术实现步骤摘要】

本专利技术涉及仿生机器人
，具体地说是指一种仿蛇搜救机器人多步态控制方法。技术背景近年来仿蛇搜救机器人在军事侦察、灾害搜救、管线巡检等领域展现出巨大的应用潜力。随着计算机技术、微电子技术及人工智能等技术的发展，仿蛇搜救机器人不断拓展出许多运动姿态，并能在未知或复杂环境下自主选择姿态运动。传统的步态包括蜿蜒、侧滑、伸缩等蛇类运动形式，它们本质上是周期变化的，可以通过在CentralPatternGenerator(CPG)中设置不同控制参数获得。但这类蛇态运动运动效率低，严重影响搜救进度。因此，仿蛇搜救机器人多步态运动拓展及控制是一个具有挑战性的课题，吸引众多学者的研究兴趣。Manzoor等人在2015年在Neurocomputing期刊上针对带有被动移动副和旋转副关节的蛇形机器人提出一种统一的神经振荡模型作为仿蛇搜救机器人的CPG控制蜿蜒、直线和折叠等多种节律性运动。Richard等人在2014年IEEE/RSJInternationalConferenceonIntelligentRobotsandSystems会议上发表了仿蛇搜救机器人的滚动和攀爬运动研究。他们通过控制仿蛇搜救机器人关节的平移和转动自由度实现仿蛇搜救机器人的滚动和攀爬运动。郁树梅等人在2011年机器人期刊上通过将仿蛇搜救机器人的运动分解到垂直和水平方向，分别考虑两方向运动控制，实现了机器人的3维运动控制。虽然这些方法能够实现仿蛇搜救机器人多步态拓展和控制，但是还存在以下主要不足：(1)设计运动步态时一般只考虑蛇态运动形式，模仿自然蛇运动，未考虑具有快速运动能力的非蛇态运动形态；(2)依托机构独有的特性设计步态控制方法，不能有效拓展出多种控制信号，难以推广应用在实际中。
技术实现思路
本专利技术的目的在于提供一种仿蛇搜救机器人多步态控制方法，控制仿蛇搜救机器人进行自然步态、轮式步态以及混沌步态运动，解决上述在基于特定仿蛇机构和传统CPG方法进行步态控制时未考虑高效运动步态生成和控制问题。本专利技术方法利用HopfieldNeuralNetwork，MotionShapeCodeTechnique设计一种针对自然步态、轮式步态以及混沌步态的多步态生成、转换以及控制方法，使仿蛇搜救机器人能在搜救任务中合理选择步态，高效完成任务。一种仿蛇搜救机器人多步态控制方法，包含以下步骤：1.1构建基于高效完成任务需求的仿蛇搜救机器人的自然步态、轮式步态以及混沌步态。1.2根据步骤1.1中的多种步态特征，建立仿蛇搜救机器人驱动模式与各步态之间的对应关系。主要的对应关系包括：通过控制仿蛇搜救机器人的关节实现自然步态。通过控制仿蛇搜救机器人的正交主动轮实现轮式步态。通过同时控制仿蛇搜救机器人的关节和正交主动轮实现混沌步态。1.3根据步骤1.1中的多种步态特征和仿蛇机器人的实现模式，采用Hopfield网络设计各个步态对应的控制信号。1.4根据步骤1.1中的仿蛇搜救机器人步态和步骤1.3中设计的Hopfield网络步态控制，设计前期的地形检测模块和步态形状生成及转换模块，完成整个仿蛇搜救机器人步态的设计和控制。步骤1.3根据步骤1.2中三种步态不同的驱动模式组成，为Hopfield网络的权重确定提供输出信号依据：自然步态运动具有周期性变化特点，期望周期性的类正弦输入信号。将正弦曲线离散化，得到步态各个时刻对应的机构输出信号，考虑到机构的机械约束，加入一个变量调节输出，然后将该信号输入到Hopfield网络中进行权重参数计算。轮式步态运动具有运动形状不变性，期望不变的稳定输入信号。考虑网络的稳定性和收敛性，通过Hopfield网络的状态方程，计算权重矩阵。混沌步态运动具有不规律性，且为保证快速性，期望随机多样的输入信号。通过尝试法选取权重矩阵参数，使Hopfield网络能输出混沌信号。步骤1.4中设计前期的地形检测模块，检测地形情况，选择合适的步态，然后通过步态形状生成模块及转换模块形成相应步态形状，最后通过Hopfield网络进行稳定步态控制，实现整个仿蛇搜救机器人步态的生成和控制。首先，在仿蛇搜救机器人头部对称布置三个InfraredRay(IR)传感器a，b，c，其中b传感器有一个垂直方向的自由度。三个传感器分别实时采集数据，将数据通过和K2=Πi=13sign(ξL-|h/cos(iφ)-lbi|)]]>计算地面的宽阔性和平坦性。如果地面不够宽阔，采用混沌步态运动。如果地面宽阔但不平坦，采用自然步态运动。如果地面宽阔且平坦，采用轮式步态运动。然后，当确定好步态运动时，通过MotionShapeCodeTechnique(MSCT)将对应步态的一个周期的输出信号输入关节驱动器，实现初始运动形状的生成。最后，当仿蛇搜救机器人形成指定步态时，通过Hopfield网络进行持续运动生成和控制。期间，检测模块持续检测，若地形出现变化，则需要变化运动步态，此时通过MSCT在两个运动周期中，以直线形状为过渡形状，实现机器人从一种工作步态到另一种工作步态。本专利技术是一种基于Hopfield网络的仿蛇搜救机器人多步态控制及转换方法，与现有的技术相比，具有以下明显的优势和有益效果：本专利技术设计过程明确简单，可实现多步态拓展、控制以及转换，方法具有通用性。本专利技术解决了现有步态生成和控制方法在步态设计时没有考虑高效运动形式的轮式运动和在特殊地形下的混沌步态问题，大大调高了仿蛇搜救机器人步态的多样性和执行任务的高效性。附图说明图1是本专利技术中的蜿蜒步态及其驱动模式示意图；图2是本专利技术中的轮式步态及其驱动模式示意图；图3是本专利技术中的混沌步态及其驱动模式示意图；图4是本专利技术中的Hopfield网络结构示意图；图5本专利技术中的基于Hopfield网络的仿蛇搜救机器人步态生成及控制方法流程图；图6～8是本专利技术中的基于Hopfield网络的仿蛇搜救机器人步态生成及控制信号仿真结果图。具体实施方式为了更好地理解本专利技术的技术方案，以一个带有正交主动轮和仿生并联关节的仿蛇搜救机器人为研究对象对本专利技术的实施方式做进一步的介绍。1.1构建基于高效完成任务需求的仿蛇搜救机器人的自然步态、轮式步态以及混沌步态。根据大多数灾害现场布满或多或少、或大或小的障碍物特点，为使仿蛇搜救机器人在较平坦地形实现快速运动，在不平坦地面为保护蛇体机构而进行蛇态运动，在狭小空间进行随机运动要求，即本文档来自技高网...

【技术保护点】
一种仿蛇搜救机器人多步态控制方法，其特征在于：包含以下步骤，1.1构建基于高效完成任务需求的仿蛇搜救机器人的自然步态、轮式步态以及混沌步态；1.2根据步骤1.1中的多种步态特征，建立仿蛇搜救机器人驱动模式与各步态之间的对应关系；所述的对应关系包括：通过控制仿蛇搜救机器人的关节实现自然步态；通过控制仿蛇搜救机器人的正交主动轮实现轮式步态；通过同时控制仿蛇搜救机器人的关节和正交主动轮实现混沌步态；1.3根据步骤1.1中的多种步态特征和仿蛇搜救机器人的实现模式，采用Hopfield网络设计各个步态对应的控制信号；1.4根据步骤1.1中的仿蛇搜救机器人步态和步骤1.3中设计的Hopfield网络步态控制，设计前期的地形检测模块和步态形状生成及转换模块，完成整个仿蛇搜救机器人步态的设计和控制。

【技术特征摘要】
1.一种仿蛇搜救机器人多步态控制方法，其特征在于：包含以下步骤，
1.1构建基于高效完成任务需求的仿蛇搜救机器人的自然步态、轮式步态以及混
沌步态；
1.2根据步骤1.1中的多种步态特征，建立仿蛇搜救机器人驱动模式与各步态之间
的对应关系；
所述的对应关系包括：通过控制仿蛇搜救机器人的关节实现自然步态；通过控制
仿蛇搜救机器人的正交主动轮实现轮式步态；通过同时控制仿蛇搜救机器人的关节和
正交主动轮实现混沌步态；
1.3根据步骤1.1中的多种步态特征和仿蛇搜救机器人的实现模式，采用Hopfield
网络设计各个步态对应的控制信号；
1.4根据步骤1.1中的仿蛇搜救机器人步态和步骤1.3中设计的Hopfield网络步态
控制，设计前期的地形检测模块和步态形状生成及转换模块，完成整个仿蛇搜救机器
人步态的设计和控制。
2.根据权利要求1所述的一种仿蛇搜救机器人多步态控制方法，其特征在于：步
骤1.3根据步骤1.2中三种步态不同的驱动模式组成，为Hopfield网络的权重确定提供
输出信号依据：
自然步态运动具有周期性变化特点，期望周期性的类正弦输入信号；将正弦曲线
离散化，得到步态各个时刻对应的机构输出信号，考虑到机构的机械约束，加入一个
变量调节输出，然后将该信号输入到Hopfield网络中进行权重参数计算；
轮式步态运动具有运动形状不变性，期望不变的稳定输入信号；考虑网络的稳定
性和收敛性，通过Hopfield网络的状态方程，计算权重矩阵；
混沌步态运动具有不规律性，且为保证快速性，期望随机多样的输入信号；通过
尝试法选取权重矩阵参数，使Hopfield网络能输出混沌信号。
3.根据权利要求1所述的一种仿蛇搜救机器人多步态控制方法，其特征在于：步
骤1.4中设计前期的地形检测模块，检测地形情况，选择合适的步态，然后通过步态

\t形状生成模块及转换模块形成相应步态形状，最后通过Hopfield网络进行稳定步态控
制，实现整个仿蛇搜救机器人步态的生成和控制；
首先，在仿蛇搜救机器人头部对称布置三个InfraredRay(IR)传感器a，b，c，
其中b传感器有一个垂直方向的自由度；三个传感器分别实时采集数据，将数据通过
和K2=Πi=13sign(ξL-|h/cos(iφ)-lbi|)]]>计算地面的
宽阔性和平坦性；如果地面不够宽阔，采用混沌步态运动；如果地面宽阔但不平坦，
采用自然步态运动；如果地面宽阔且平坦，采用轮式步态运动；
然后，当确定好步态运动时，通过MotionShapeCodeTechnique(MSCT)将对应步
态的一个周期的输出信号输入关节驱动器，实现初始运动形状的生成；
最后，当仿蛇搜救机器人形成指定步态时，通过Hopfield网络进行持续运动生成
和控制；期间，检测模块持续检测，若地形出现变化，则需要变化运动步态，此时通
过MSCT在两个运动周期中，以直线形状为过渡形状，实现机器人从一种工作步态到
另一种工作步态。
4.根据权利要求1所述的一种仿蛇搜救机器人多步态控制方法，其特征在于：
1.1构建基于高效完成任务需求的仿蛇搜救机器人的自然步态、轮式步态以及混
沌步态；
根据大多数灾害现场布满或多或少、或大或小的障碍物特点，为使仿蛇搜救机器
人在较平坦地形实现快速运动，在不平坦地面为保护蛇体机构而进行蛇态运动，在狭
小空间进行随机运动要求，即仿蛇搜救机器人需要自然、轮式以及混沌三类运动模式，
进而高效完成任务；
自然步态主要指蛇的蜿蜒、侧滑、伸缩运动，这种蛇态运动利用机体和环境间的
各向异性摩擦力，推动仿蛇搜救机器人向前运动，具有环境高适应性；轮式步态主要
有U形、具有不同运动方向的N形等类轮式运动，这种轮式运动利用机体形状类轮式
特性，可以做轮式运动，实现运动的快速性；混沌步态模仿蛇在狭小空间扭动逃离动
作，避免机体被困而无法进行运动控制；
1.2根据步骤1.1中的多种步态特征，建立仿蛇搜救机器人驱动模式与各步态之间
的对应关系；
仿蛇搜救机器人模型中主动轮的旋转轴与关节的轴向方向正交，即仿蛇搜救机器
人沿着YS轴运动，机身沿着XS轴分布，其中XS与YS垂直；其中的主动关节为仿生
并联关节，采用2-UPS/U机构，能实现强承载，大输出并具有自锁性；机构的输入为
两个直线驱动器的直线位移变化，输出是活动的关节平面；关节俯仰角和直线驱动器
的关系通过下式计算：
θ=arcsin(ΔxL/2)=arcsin(2ΔxL)---(1)]]>通过控制仿蛇搜救机器人的正交主动轮和仿生并联关节，可以产生自然、轮式和
混沌运动形式；
(1)自然步态：主要指蛇的蜿蜒、侧滑、伸缩运动；这类周期性变化的步态，
可以通过控制仿蛇搜救机器人关节实现，每个关节俯仰推进机器人前进；
(2)轮式步态：主要有U形、具有不同运动方向的N形轮式运动；利用正交主
动轮产生的附加运动自由度，仿蛇搜救机器人可以产生类似轮式机器人的运动形式；
具体是先通过控制关节使机器人各个单元到达期望位形，再通过控制轮子进行后续类
轮式运动；
(3)混沌步态：模仿蛇在狭小空间扭动逃离动作；给关节混沌随机信号，在主
动轮的帮助下，尝试多方向运动，逃离未知狭小环境；
1.3根据步骤1.1中的多种步态特征和正交主动轮式仿蛇搜救机器人的实现模式，
采用Hopfield网络设计各个步态对应的控制信号；
1.3.1HNN模型
通过调整权重参数可以得到不同的输出信号，与步骤1.1中的多种步态特征具有
一致性；用于本方法的正交主动轮仿蛇搜救机器人模型的HNN模型的权重矩阵为
[wij]9×9；
1.3.2自然步态中的蜿蜒步态分析
针对自然步态中最典型、常见的蜿蜒步态，确定HNN的相关参数，使网络输出
的输出满足蜿蜒步态输入控制信号要求；
根据蜿蜒运动周期变化特点，每个关节当前运动状态必然收敛到下一刻运动状
态；这样为了确定HNN的权重参数，定义Ci＝1,Ri＝1，从HNN模型出发推导如下：
x·i(k)=-xi(k)+Σj=1Nwijf(xj(k))+θi---(2)]]>x·i(k)+xi(k)=Σj=1Nwijf(xj(k))+θi---(3)]]>xi(k+1)=Σj=1Nwijf(xj(k))+θi---(4)]]>选取非线性饱和函数作为传递函数，则：
X(k+1)＝X(k)WT+θ...

【专利技术属性】
技术研发人员：曹政才，翁志萍，吴春成，肖清，李萌，付宜利，
申请(专利权)人：北京化工大学，
类型：发明
国别省市：北京;11