一种具有容错控制功能的智能球形机器人研究.docVIP

一种具有容错控制功能的智能球形机器人研究 　　【摘 要】 随着科学技术的迅猛发展，智能机器人领域的研究和应用得到了广泛的进步，其中智能球形机器人的成功设计和应用研究也得到了普遍的关注。本文作者将提出一种具有容错控制功能的智能球形机器人研究，通过对球形机器人的多自由度机械结构设计和姿态解算控制算法的分析研究，最后决定采用故障检测法结合姿态调整算法实现其容错性。 　　【关键词】 球形机器人 容错控制 多自由度机械结构 姿态解算 故障检测 　　目前，国内外有很多球形机器人的成功设计，他们所采用的驱动结构和行进方式也多式多样，与传统的轮式和履带式机器人相比，这种设计只实现了球形外部结构的设计，普通机器人因缺乏智能的容错控制功能而导致其在复杂的工作环境中容易受损而不能正常工作的问题仍然影响着智能机器人研究领域的快速发展。本文作者将提出一种具有容错控制功能的智能球形机器人研究，该球形机器人分上下两个半球面，各有六只机械足，每只机械足由3个舵机构成三个自由度，通过下半球机械足的摆动调整姿态，实现多向运动。当自身某条或多条机械足出现故障，它能自动检测并通过步态改变，继续前行。其结构原理基于它运动的非完整性约束，利用广义欧拉角给出运动微分方程，建立运动学模型。该球形机器人运动灵活，机动性好，善于穿越崎岖的地形，在各个领域都将具有广泛应用前景。 　　1 基于容错控制的机械结构设计 　　1.1 多自由度的机械足结构设计 　　本文研究的球形机器人其特征在于包括上下两个半球面，上半球面和下半球面围成一个球体。上半球和下半球分别均匀的由六支扇形的机械足构成，其中上半球面每支机械足由一个舵机和中间固定板连接而成的一个自由度构成。下半球面每只脚由三个舵机相互连接而成的三自由度机械足构成，六只脚均匀分布在下半球面，和上半球面六只机械足对称的分布在中间连接板两侧，整体构成一个完整的球状机器人。该设计方案相比与轮式和履带式机器人，具有落足点离散，主动隔振以及对地表状况适应性强等众多特点。当上下半球面均处于收缩状态时便构成了可实现整体滚动的球形状态，上半球面展开便构成了一个用于搬运物质的水平托举平台，下半球面展开便可实现六足行走的功能，每只脚三个自由度可配合完成机器人的前进，侧移和旋转运动，当其中某只脚受损时，其他五只脚自动调节运行步态，恢复正常运行状态，实现容错控制。 　　1.2 错误信号检测传感器的选择及其安装 　　要实现机器人在运行过程中的容错控制功能和托举平台始终处于水平状态，首先要得到机器人在运行过程中的姿态数据和各自由度的工作状态。本文采用整合性6轴运动处理组件MPU6050来检测机器人运动姿态，紧贴在中间固定板的下表面，免除了组合陀螺仪和加速度计轴间差的问题，体积小，角度数据采集精度高，将数据实时反馈给机器人中央控制模块，控制模块通过控制各自由度姿态调整来实现托举平台处于水平状态。故障检测则采用WCS2202霍尔电流传感器来监控各自由度控制舵机是否工作异常，该模块集成设计在控制电路板上，结构简单，数据采集稳定，若发现电流异常，便立刻控制其他自由度通过其余机械足的姿态调整来保证机器人处于正常运行状态。 　　2 球形机器人运动控制系统的实现 　　2.1 研究平台设计 　　本设计平台的系统组成如图1所示。其中，微控制器选用飞思卡尔公司的MK10DN512VLL10，该微处理器具有32位ARM Cortex-M4内核，运行主频可达到200HZ，为运动控制和姿态解算算法的可靠运行提供了硬件基础。ADC模块作为用于故障检测的霍尔电流传感器采样和压力感应传感器的信号检测，准确保证了机器人的容错控制运行和水平托举平台的闭环反馈控制，IIC可以实现远程通讯和数据传输，用于机器人的远程控制和通信。PWM模块用于驱动上下半球面的舵机，从而实现机器人的调整和运行。各模块相互配合，实现离散采集，整体控制。 　　2.2 机器人正常运行及容错姿态控制 　　在完成上述控制系统的整体设计后，就可以对其在正常情况下和故障情况下的运行状态进行姿态解算和步态控制分析，首先我们对机器人在正常情况下运行的姿态进行分析，其姿态解析如图2和图3所示。 　　假设以3号脚为前进方向，则1号脚和5号脚同时运动，2号脚和4号脚同时运动，且运动步态一致，3号脚和6号脚以互补姿态运动，现以1号机械足和3号机械足为例进行姿态解算。 　　对于1号脚，OC为机械足第一段，其长度为；CB为第二段，其长度为，前进速度每步为，关节一摆动角为，根据图中的几何关系可以得到以下关系式： 　　根据以上关系式，在确定步长的情况下，便可求出转动角。 　　对于3号脚，FG为机械足第二段，其长度为，GK为机械足的第三段，其长度为，关节2的摆动角为，关节三的摆动角为。根据图三的几何关系可以得到以下关