一种应用于六足机器人的共享因子模糊推理器制造技术

本发明专利技术属于足式机器人遥操作技术领域。本发明专利技术公开了一种应用于六足机器人的共享因子模糊推理器，解决了多足机器人在复杂地形下执行特种任务时容易出现的失稳问题。本发明专利技术所述的一种应用于六足机器人的共享因子模糊推理器，在速度‑位姿协同遥操作系统的基础上设计了能够实现共享特征的协同操控的二维遥操作系统；通过稳定裕度判据分析多足机器人的稳定情况，通过模糊推理系统产生共享因子α对遥操作子系统进行操控权重的分配；通过主端控制器将操控误差和多足机器人的控制需求相结合并以触觉引导力的形式反馈于操作者。本发明专利技术能够有效解决多足机器人在崎岖地形下容易出现的试问问题，在保证系统透明性的同时减轻了操作者的工作压力。

A Shared Factor Fuzzy Reasoner for Hexapod Robots

The invention belongs to the technical field of foot robot teleoperation. The invention discloses a shared factor fuzzy reasoner applied to hexapod robots, which solves the instability problem of multipod robots when performing special tasks under complex terrain. A shared factor fuzzy inference device for hexapod robot is described in this paper. Based on the speed, position and attitude cooperative teleoperation system, a two-dimensional teleoperation system is designed to realize the cooperative manipulation of shared features. The stability of a multi-legged robot is analyzed by the stability margin criterion, and the teleoperation subsystem is controlled by the shared factor alpha generated by the fuzzy inference system. Distribution of weights; Combining the control errors with the control requirements of the multi-legged robot through the main controller and feeding back to the operator in the form of tactile guidance force. The invention can effectively solve the probation problems easily occurring in the rugged terrain of the multi-legged robot, ensure the transparency of the system and reduce the working pressure of the operator.

【技术实现步骤摘要】
一种应用于六足机器人的共享因子模糊推理器
本专利技术属于足式机器人遥操作
，具体涉及一种针对崎岖地形下操作者遥操作六足机器人完成高效、平稳行走的共享因子模糊推理器及其实现方法。
技术介绍
由于足式步行机器人在面对复杂地形时具有比轮式或履带式移动机器人更强的适应能力和通过能力，使得其在灾难救援、海空探索、勘探等领域得到了广泛的运用。但需要认清的是，足式机器人虽然可以取代人类出现在危险的工作环境中，但由于工作现场的复杂程度不可预期，若单纯依靠机器人自身的智能控制算法还难以保证机器人自主适应复杂多变工况下的任务需求。为了提高机器人在执行任务过程中的稳定性，需要通过遥操作系统将将人的感知、决策能力融入整个控制系统中，以此改善机器人的运动性能，使其能够更好的完成所制定的特殊任务。然而通过对现有六足机器人遥操作控制方法研究发现，现有的遥操作控制方法大多采用单主-单从(SMSS)控制构架对机器人的行进速度进行操控。当机器人处在崎岖不平的地面条件下，此时机器人规划的落足位置与实际位置之间会有较大差异，因此六足机器人可能出现目标运动方向上的速度损失，机体的波动可能造成机器人稳定裕度的不足，此时若采用这种控制构架很难满足足式机器人在崎岖地形下对稳定裕度的需求，在操作过程中机器人容易出现失稳甚至倾翻，由此导致运动失控、驱动系统失效、元器件损坏等问题；采用多主单从(MMSS)控制构架对机器人的行进速度与机体位姿进行协同操作可以更好的控制六足机器人在崎岖地形下的行进任务。通过引入共享因子对两遥操作子系统进行分权处理则能帮助操作者更有效率的完成操作任务，同时能够更好的保证机器人的稳定性。如何开发一种应用于六足机器人的共享因子模糊推理器以对两遥操作子系统进行权重的分配是本专利技术拟解决的主要控制技术难题。
技术实现思路
本专利技术的目的是提供一种应用于六足机器人的共享因子模糊推理器，实现对遥操作子系统的分权处理，以弥补现有控制策略存在的不足。为了解决上述技术问题，本专利技术是通过以下技术方案实现的：一种应用于六足机器人的共享因子模糊推理器，具体包括以下步骤：步骤1：对主端机器人进行动力学建模，从端机器人进行运动学建模；步骤2：针对崎岖地形下行进的六足机器人的稳定裕度进行计算与分析，建立以稳定裕度为输入共享因子为输出的模糊推理系统；步骤4：根据步骤1所建立的数学模型，结合步骤2求出的共享因子，设计具有共享因子的速度层遥操作子系统的控制算法，并通过无源性准则对控制律参数进行求解；步骤5：根据步骤1所建立的数学模型，结合步骤2求出的共享因子，设计具有共享因子的位姿层遥操作子系统的控制算法，并通过无源性准则对控制律参数进行求解；本专利技术有以下有益效果：所述的一种应用于六足机器人的共享因子模糊推理器，一方面，与现有的大多数遥操作系统相比具有本专利技术所提出的共享因子模糊推理器的双边触觉遥操作系统能够更好的满足六足机器人在崎岖地形下对稳定裕度的需求；另一方面本专利技术设计的模糊推理器使得机器人可以根据自身稳定情况对操作者操作权重进行自动分配，并且通过输出触觉力反馈引导操作者进行操控，大幅度减轻了操作者在复杂环境下操作机器人时的工作压力；最后具有本专利技术所提出的共享因子模糊推理器的遥操作系统缓解了机体整身的运动状态在崎岖地形下出现的剧烈变化，从而减少了目标运动方向上的速度损失，提高了系统的透明性。附图说明图1为六足机器人的本体结构示意图；图2为模糊推理系统结构框图图3为模糊因子α的模糊规则表图4为遥操作系统整体构架示意图图5为具有共享因子的速度层遥操作系统控制构架示意图图6为具有共享因子的位姿层遥操作系统控制构架示意图具体实施方式下面结合附图和实施例对本专利技术的实施方式作进一步详细描述。本专利技术的一个实施例：一种应用于六足机器人的共享因子模糊推理器，其内容包括以下步骤：步骤1：对主端机器人进行动力学建模，从端机器人进行运动学建模；其具体实施方式如下：主端机器人动力学方程如下：其中下标1代表速度层主端机器人，2代表位姿层主端机器人，τm为主端机器人的控制律，τh为操作者施加于主端机器人上的力，Mm为主端机器人的质量，Bm为主端机器人的阻尼系数，qm为主端机器人的位置向量；特性1：Mm为正定矩阵；特性2：是斜对称矩阵；在对六足机器人的机体速度进行跟踪控制时，为了保证速度层的主端机器人系统的输出无源性，将一个新的控制变量(0<λ<1)引入到速度层的主端机器人控制系统中，通过在原始位置变量中加入一个阻尼项，以此保证系统的无源性；修正后的控制律为式中为局部控制律，为全局控制律，且式中修正后的速度层主端机器人的动力学模型为：从端机器人的构型如图1所示，以六足机器人的一条腿作为研究对象，建立机器人单腿D-H坐标系。机器人单腿正运动学表达式为：式中代表机器人第i条单腿足末端在机体坐标系下的位置坐标，c代表cos，s代表sin。单腿逆运动学表达式也可推导得：式中本专利技术以从端机器人三足支撑状态为研究对象对从端机器人的机体进行运动学建模。以机体支撑足为1、3、5号腿时的状态为研究对象，机器人机体的正运动学表达式为：式中[GPiGPiGPi]T为i号单腿的足端在世界坐标系中的坐标，[OPiOPiOPi]T为i号单腿的足端在机体坐标系中的坐标，OTC为机体坐标系相对于世界坐标系的转换矩阵。由上可得机器人机体的逆运动学表达式为：步骤2：针对崎岖地形下行进的六足机器人的稳定裕度进行计算与分析，建立以稳定裕度为输入共享因子为输出的模糊推理系统；其具体实施方式如下：采用SSM(staticstabilitymargin)稳定判据分析六足机器人在行进过程中的机体稳定情况，即机器人的重心CG投影点始终落在支撑多边形在水平面的投影范围内，则认为机器人是稳定的；CG投影点距离投影支撑多边形各边的最小距离为SSM稳定裕度。设点P为机器人重心，将P投影点P′到投影支撑多边形所在的平面中，其中最小值即为其SSM稳定裕度：式中i,j＝1,2,3,4,5,6，aij为机器人足端点坐标。模糊推理系统构架如图2所示，系统的输入稳定裕度S的论域划分为S＝{-6,-5,-4,-3,-2,-1,0,+1,+2,+3,+4,+5,+6}，采用7段模糊子集{负大，负中，负小，零，正小，正中，正大}描述，记为{NB,NM,NS,ZO,PS,PM,PB}；输出变量共享因子α的论域划分为α＝{-3，-2，-1，0，1，2，3}，采用7段模糊子集{负大，负中，负小，零，正小，正中，正大}描述，记为{NB,NM,NS,ZO,PS,PM,PB}。考虑到对论域的覆盖程度和灵敏度，稳定性和鲁棒性原则，各模糊子集选用三角形隶属度函数。共享因子α具体调整规则如下：1、若S开始向较小值变化，则共享因子α减小，即控制权开始向位姿层转移，目的在于使操作者更容易地调整机体位姿，同时机器人的减速行为可以为其调整状态提供充分时间，此时速度层主端机器人会增大产生由误差产生的拉力以阻止操作者继续加速，位姿层主端机器人会增大由误差产生的推力使操作者更有效率的对位姿层进行调整；2、若S开始向较大值变化，则共享因子α增大，即控制权开始向速度层转移，目的在于使操作者更容易地对机器人的速度进行控制，此时速度层主端机器人会增大产生推力以鼓励操作者对机器人进行加本文档来自技高网...

【技术保护点】
1.一种应用于六足机器人的共享因子模糊推理器，其特征在于：所述的六足机器人的共享因子模糊推理器包括：稳定裕度计算模块、模糊推理系统、共享因子。

【技术特征摘要】
1.一种应用于六足机器人的共享因子模糊推理器，其特征在于：所述的六足机器人的共享因子模糊推理器包括：稳定裕度计算模块、模糊推理系统、共享因子。2.根据权利要求1所述的一种应用于六足机器人的共享因子模糊推理器，其特征在于：所述的稳定裕度计算模块以世界坐标系下机器人处于支撑相的各足端坐标与机器人重心坐标为输入，采用SSM(staticstabilitymargin)稳定判据计算出机器人的稳定裕度，将其作为分配操作者对于机器人速度与位姿操控权重的判据；所述的模糊推理系统以机器人稳定裕度为输入，通过隶属度函数进行模糊化，隶属度函数将精确的输入值转化为对应的模糊集以及相应的隶属度，再对规则库中的规则进行匹配，根据每条规则，利用三角形隶属度函数计算在对应模糊集上的隶属度，再对规则进行匹配，根据模糊规则计算出对性的规则可信度，将可信度进行反模糊化处理得到输出变量共享因子α；所述的共享因子α为操作者对六足机器人机体速度与位姿的控制权重，其中α∈[0，1]；当α＝0.5时，操作者对机器人机体速度与位姿的控制为平权；当α＝1时，操作者无法对机体位姿进行控制，对机体速度的控制变得更加灵活；当α＝0时，操作者无法对机体速度进行控制，对机体位姿的控制变得更加灵活；通过机器人稳定裕度模糊推理得出的共享因子能够体现机器人为保证自身稳定性对速度与位姿的控制需求。3.一种应用于六足机器人的共享因子模糊推理器，其特征在于：一种应用于六足机器人的共享因子模糊推理器的具体实施方法可分为以下步骤：步骤1：设计机器人稳定裕度计算模块，其输入为世界坐标系下机器人处于支撑相的各足端坐标与机器人质心坐标，输出为机器人稳定裕度；步骤2：设计共享因子模糊推理系统，系统通过分析稳定裕度确定六足机器人对速度与位姿的控制需求，系统输入为机器人稳定裕度，输出为共享因子；步骤3：设计速度层与位姿层遥操作子系统的触觉力反馈模式，使操作者能够以力的形式感受到操作过程中产生的误差以及机器人对操控者的操控需求。4.根据权利要求3所述的一种应用于六足机器人的共享因子模糊推理器，其特征在于：步骤1中所述的设计机器人稳定裕度计算模块，即采用SSM稳定判据针对行进状态下的六足机器人的稳定裕度进行计算与分析，通过机器人自身携带的传感器获取机器人在世界坐标系下的的重心CG位置与支撑相足端位置，机器人的重心坐标始终落在支撑多边形在水平面的投影范围内，则认为机器人是稳定的；重心坐标距离投影支撑多边形各...

【专利技术属性】
技术研发人员：尤波，陈翰南，李佳钰，
申请(专利权)人：哈尔滨理工大学，
类型：发明
国别省市：黑龙江,23