CN101850548B - 一种基于飞轮的倒立摆平衡控制系统 - Google Patents

Abstract

本发明属于智能机器人范畴，尤其是一种能够自主进行平衡控制的静态不平衡机器人。本发明利用直流伺服电机控制飞轮沿着竖直方向旋转，实现左右方向的平衡。检测方面，为了实现摆杆在摆动过程中对自身姿态的检测，采用基于微机械电子技术的惯性导航系统和倾角仪获得摆杆的运动信息。安全性方面，在摆杆的两侧安装了可以方便调节摆杆最大倾角的摆杆侧支架，在实验中既可以保护系统的元器件又能满足不同的控制要求。为了减少控制难度，把一些电子器件如电源、运动控制器、伺服驱动器及电源转接板等放在底座上，减少了摆杆的控制难度，增加了系统的稳定性。可移动性方面，底座的四个拐角处安装了带有刹车功能的脚轮，便于系统在不同的地方进行调试。

Description

一种基于飞轮的倒立摆平衡控制系统

技术领域

本发明属于智能机器人范畴，尤其是一种能够自主进行运动平衡控制的静态不平衡机器人。

背景技术

倒立摆系统的控制是控制理论应用的一个典型范例。其机构简单、成本较低，便于用模拟或数字的方法进行控制。虽然其结构形式多种多样，但无论何种结构，就其本身而言，都是一个非最小相位、多变量、绝对不稳定的非线性系统。由于倒立摆系统的绝对不稳定，必须采取有效的措施控制它。其控制方法在军工、航天、机器人领域和一般工业过程中都有着广泛的用途，如机器人行走过程中的平衡控制、火箭发射中的垂直度控制和卫星飞行中的姿态控制等涉及到的倒置问题。同时，由于摩擦力的存在，该系统具有一定的不确定性。对于这样一个复杂系统的研究，从理论上将涉及系统控制中的许多关键问题：如非线性问题、鲁棒性问题、镇定问题、随动问题及跟踪问题等可以以它为例进行研究。

随着倒立摆系统的控制研究的不断深入，倒立摆系统的种类也由简单的单级倒立摆发展为多种形式的倒立摆。常见的倒立摆系统一般由小车和摆杆两部分构成(另有旋转式倒立摆等形式，但较少)，其中摆杆可能是一级、两级甚至多级，其长度也可能是变化的。控制的目标基本上都是通过给小车施加一个水平方向的力，使小车在期望的位置上稳定，而摆杆也达到竖直向上的动态平衡状态。

相比于一般的倒立摆系统，基于飞轮的倒立摆平衡控制系统具有以下显著特点：1)平衡原理不同：一般的倒立摆都是通过控制小车的速度来达到竖直摆杆的平衡，而基于飞轮的倒立摆系统的底部却是固定的，它是通过顶部飞轮的旋转产生必要的扭矩来控制摆杆的平衡；2)控制难度不同：对于一般的倒立摆系统，四级倒立摆的控制目前也已经不是问题了，而对于基于飞轮的倒立摆系统而言，二级倒立摆的控制至今还没有人去研究。3)应用层次不同：一般的倒立摆系统主要用来研究系统的稳定性、鲁棒性、镇定问题等等。随着科技的发展，人们生活水平的提高，人们越来越追求自己生活的质量和舒适程度，于是，一些智能机器人应用而生，由于他们的体积小、重量轻、功能多，逐渐被现代人追捧，其中，极具有代表性的是独轮机器人，它只有一个轮子，占有更小的空间，能够以一种特有的动态平衡的方式实现相应的任务，如在极窄的路径上骑行，骑过很窄的平衡木、原地转身，甚至可以完成走钢丝的高难度动作。对于它上身的控制，目前许多研究者都是基于飞轮旋转的平衡控制，但是目前在国内还没有一个能够独立行走的独轮车。

现在的倒立摆多为简单的杆式倒立摆，为了增强其控制难度，只是摆杆的简单叠加，现实意义不是很大。它的电气控制系统一般在摆杆的下端，小车的快速滑动是通过电机带动的皮带来传动，从而使轻质摆杆起摆，最终使竖直摆杆稳定在垂直向上的位置。由于此装置一般体积大、质量重，从而造价也比较高。

国外也有许多研究者致力于基于飞轮的倒立摆平衡控制系统的研究，具有代表性的是Model IP/NC Inverted Pendulum，此系统采用的是110或220伏的交流供电方式；传感器使用的是红外传感器，它是一种模拟传感器，测量精度不高，影响系统的控制；它的保护支架是固定的，不能调节摆杆与竖直方向的最大偏角，缺少一定的灵活性；其电气系统并没有放在底座上，底座上也没有可以移动的脚轮，可移动性较差。

针对上述问题，本发明设计了一种基于飞轮的倒立摆平衡控制系统。倒立摆系统利用模块化的平衡组件中的直流伺服电机控制飞轮沿着竖直方向旋转调节，实现左右方向的平衡。检测方面，为了实现倒立摆对摆杆姿态的实时检测，本发明采用了基于微机械电子技术的惯性导航系统和单轴的倾角仪获得摆杆系统在二维环境中的精确姿态。为了使倒立摆具有移动的方便性，在本发明中倒立摆系统的底盘下安装了四个脚轮，当需要移动倒立摆系统时，可以很方便、省力的由一个位置移动到另一个位置。

发明内容

本发明的目的在于提出一种基于飞轮的倒立摆平衡控制系统，从而在一定程度上解决独轮机器人的侧向平衡控制问题。

本发明的具体方案为：一种基于飞轮的倒立摆平衡控制系统，包括摆杆和底座，其特征在于在摆杆的顶端固定一个包含有减速器的直流无刷伺服电机，在电机旋转轴的前端装有一个可随之一起旋转的飞轮，电机的另一端与增量式编码器连接；摆杆的两侧安装有倾角传感器和倾角速度传感器；摆杆的底部通过摆杆旋转轴与底座上的摆杆支撑座连接；底座上布置有电源、伺服驱动器、电源转接板、运动控制器，其中倾角传感器、倾角速度传感器和增量式编码器的输出端分别于运动控制器连接，运动控制器的输出端与伺服驱动器连接，伺服驱动器的输出端与增量式编码器连接，倾角速度传感器、伺服驱动器、电机分别由电源直接供电，倾角速度传感器和运动控制器由电源转接板将电源的电压转换后供电。

为了防止摆杆由于控制失败发生倾倒，碰坏底座上的其他器件，可以在摆杆的两侧对称安装有两个侧支架，或者在底座的两侧放置竖直保护架。

其中的飞轮可以被设计成重量主要集中于圆周的形状，以提高其转动惯量。

作为对本发明的进一步改进，可以在底座四角的下部分别安装有具有各自的刹车系统的脚轮，这样整个系统可以比较方便、省力的移动位置，也可以在需要的时候固定在某个位置。

作为对本发明的进一步改进，还可以在飞轮中心套管的外部安装一个轴承，以为了减小飞轮重力对电机轴的压力。

本发明具有以下优点：

第一，本发明的所有组件均采用模块化的设计思想，每个组件都可以拆卸更换，如平衡组件中控制用的惯性飞轮，当一种惯性飞轮不满足控制要求或者需要更换其它飞轮进行相关实验时，可将其拆卸，然后安装上需要的飞轮，在这个过程中不需要将平衡组件中的其它器件拆下。这为系统的维护和升级提供了极大的方便。

第二，本发明的可调式摆杆侧支架不仅可以根据倒立摆调试的需要改变摆杆侧支架的支撑高度，而且作为摆杆组件的保护装置，避免倒立摆在调试过程中的意外倾倒，还可以作为摆杆的配重，使得系统的重心尽量向下移动，有利于减少系统控制的难度。

第三，本发明的底座上放有系统控制需要的所有电子元器件，且底座下部还有便于移动的脚轮，脚轮上有防止滑动的刹车系统，这样的设计，极大的增加了系统的可移动性，同时也是模块化思想的一种体现。

以下结合附图说明和具体实施方式对本发明作进一步的详细说明。

附图说明

图1基于飞轮的倒立摆平衡控制系统机械结构等角轴侧图；

图2基于飞轮的倒立摆平衡控制系统机械结构前视图；

图3基于飞轮的倒立摆平衡控制系统飞轮部分局部视图；

图4基于飞轮的倒立摆平衡控制系统机械结构侧视图；

图5基于飞轮的倒立摆平衡控制系统机械结构上视图1；

图6基于飞轮的倒立摆平衡控制系统机械结构后视图；

图7基于飞轮的倒立摆平衡控制系统机械结构上视图2；

图8基于飞轮的倒立摆平衡控制系统电气系统接线图；

图中：1-飞轮，2-轴承，3-电机支架，4-电机，5-摆杆，6-摆杆侧支架，7-脚轮，8-底座，9-摆杆旋转轴，10-摆杆支撑座，11-轴承端盖，12-电机套管，13-增量式编码器，14-倾角速度传感器，15-倾角传感器，16-伺服驱动器；17-运动控制器，18-电源转接板，19-电源，20-竖直保护架，21-底座小孔，22-小孔矩阵。

具体实施方式

实施例一

1机械结构

本实施例总重量7kg，高度700mm，长度400mm，宽度320mm，角轮(7)直径38mm。倒立摆系统的机械结构和电器元件布局如下(图1)：

如图2，3，4所示，整个倒立摆为铝合金框架，主要包括飞轮1、电机套管12、摆杆5、摆杆侧支架6、底座8，脚轮7。飞轮1和电机套管12之间采用轴承2连接。电机套管12与摆杆5之间采用电机支架3相连接。倒立摆系统的飞轮1为中空的十字支撑架且外围为较厚的铝合金板，使得其质量大部分集中于飞轮的边缘，增加飞轮的转动惯量，为了减少飞轮旋转起来的摩擦力，本设计把中空的十字支撑架磨成一定程度的圆角，在十字支撑架的中心突出一个空芯的套管，把电机轴插入套管，为了减小飞轮重力对电机轴的压力，在电机套管12的末端、飞轮中心套管的外部安装了一个轴承，且电机套管12的末端还安装了一个轴承端盖11，用以保护和固定轴承。通过飞轮中心套管上的两个加紧螺丝加紧电机的旋转轴，使飞轮在高速旋转过程中不至于被抛出去。摆杆5的两侧设置有防倒保护的摆杆侧支架6，当倒立摆由于某种原因没有控制好时，摆杆5就会倒下去，如果没有摆杆侧支架6来支撑的话，倒立摆上的一些器件就可能由于碰撞而摔坏，同时，为了使用上的方便与灵活，在摆杆5下半部分的前后两侧各设计有10×2的小孔矩阵22(安装方式可达9！种)，用以固定摆杆侧支架6，且摆杆侧支架6设计成一端有一小孔，小孔的下面有一段中空的摆杆侧支架6，当摆杆侧支架6的小孔固定在右列时，中空的摆杆侧支架6最多有9种与小孔矩阵22左列固定的方式。因此，摆杆侧支架6可以变换多种位置安装。摆杆5和底座8是通过一根摆杆旋转轴9和摆杆支撑座10连接，且旋转轴的两侧安装有两个同种型号的轴承。底座10上利用亚克力板固定运动控制器17、驱动器16和电源转接板18，底座上的电源19为可插拔的块状电池，在实际使用过程中相当方便，当底座上的电池没电时，只要按一下电池块下部的开关，电池就可以顺利取下来，不用拧取任何一个螺丝，更换新电池时，顺着插槽，只需轻轻一推就可以了。在倒立摆系统底座的下部四个拐角处各装有一个脚轮7，是整个系统的移动装置，当移动到一个固定的位置时，可以利用角轮上固有的刹车装置来固定倒立摆系统的位置，以免在实验过程中影响系统的控制。

2.电气系统选型

运动控制器17选用飓风数字系统(北京)有限公司MTK2812系统板。该系统的处理器采用TI公司TMS320F2812 DSP，系统为5V直流供电。

MTK2812的仿真器选用飓风数字系统(北京)有限公司的XDS510USB，USB2.0接口。伺服驱动器16选用Copley Motion公司的ACJ-55-18。倾角传感器15选用Crossbow公司的CXTA-01双轴倾角仪。倾角速度传感器14选用的是微机械陀螺仪CRS03-02(由于在安装位置处预留了其它的安装方式，故也可以使用ADIS16355陀螺仪)。

机器人的驱动电机4选用Maxon公司的直流无刷电机套件RE35，24V供电，90W功率，3.7∶1的行星齿轮减速器GP32C，电机配有增量式光电编码器，精度为500线。

锂电池选用LBS-100C标准锂电池19，标称电压：29.6V，工作范围：33.6V-24V，标称容量：150Wh，保护电路：内置过充、过放、过流及短路保护，集成电量监控。

电源转接板：华北工控PW-4512电源模块18，给控制器及其他电子器件供电，输入电压：16-40V DC，输出电压：ATX：+3.3V@5A，+5V/+5VSB@5A，+12V@5A，-12V@0.8A。

3.电气系统连接

如图8所示，电气系统各部分的连接方法如下：

MTK2812由电源转接板18的+5V输出供电，它的J7接口的38脚，即A/D转换输入通道，J5的22脚，即SPI引脚，分别与倾角仪CXTA01和陀螺仪CRS03-02的SPI信号输出端连接；陀螺仪14由MTK2812的J5接口提供+5V输出供电；倾角仪15则由电源转接板18的24V输出供电。

MTK2812与ACJ-55-18间的连接包括控制信号线和编码器反馈信号线。控制信号包括电机使能信号、电机转动方向信号和PWM转速控制量信号。其中，MTK2812的J7接口的22脚与控制电机的ACJ-55-18的J5接口的3脚连接，作为ACJ-55-18的使能信号线；MTK2812的J7接口的20脚与控制电机的ACJ-55-18的J5接口的6脚连接，作为电机4转动方向选择信号线；MTK2812的J7接口19脚为PWM输出，与控制电机4的ACJ-55-18的J5接口的20脚连接，作为转速控制量信号线。电机编码器的反馈信号经ACJ-55-18缓存后连接至MTK2812，具体接线为ACJ-55-18的J5接口的10、11脚，分别接MTK2812的J6接口的13、14脚。

ACJ-55-18的J3接口的3、4脚为电源输入端，分别接电源输出的GND和+24V；J2接口的3、4脚为控制电压的输出端，分别与电机的+/-输入端连接，其中3脚与电机+输入端之间串接一个电机开关；J4接口的4、6分别为+5V和GND，分别与编码器排线的2、3线连接，J4接口的1、8、2、9、3、10脚为编码器A通道、B通道和零位信号的共模输入端，分别接编码器排线的5、6、7、8、9、10线。

锂电池19经一个双刀双掷的船型开关与电源转接板18连接。电源转接板18的+/-输入端连接锂电池19的+/-端，提供±12V，±5V，±3.3V直流输出，分别连接各对应设备的供电端。

4.电气系统的工作原理

本实施例倒立摆系统的主要功能是通过飞轮的快速旋转产生一定的扭矩，利用飞轮产生的扭矩抵消摆杆系统(包括电机)和飞轮的重力矩及摩擦力矩，使得摆杆最终稳定在竖直向上的位置。由此，倒立摆电气系统的工作原理如图8所示：倒立摆系统的运动控制器17由模数转换模块得到倾角仪15、陀螺仪14的检测信号，经过伺服驱动器16读取编码器的反馈信号，然后，综合接收到的检测信号和反馈信号，按预定的运动平衡控制算法计算出电机的转矩控制量，发送对应的PWM信号给伺服驱动器16执行；伺服驱动器16控制电机4运动，电机带动飞轮1旋转使倒立摆摆杆最终稳定在竖直向上的位置。

实施例二

倒立摆系统的飞轮1为中空的十字支撑架且外围有较厚的铝合金板，使得其质量大部分集中于飞轮的边缘，增加飞轮的转动惯量，为了减少飞轮旋转起来的摩擦力，可以把中空的十字支撑架磨成一定程度的圆角，减少阻力，在十字支撑架的中心突出一个带有螺纹的轴，通过把此轴旋转到电机的旋转轴里(电机轴内预先留有轴孔)，而不是一般的垂直加压，为了保护电机轴，在电机轴的外面、电机套管12的末端安装有一个轴承，且电机套管12的末端部有电机端盖11加以保护和固定轴承，避免由于飞轮的重量而把电机轴压弯，这样，在电机地高速旋转过程中，飞轮就不至于被抛射出去。

实施例三

本发明在底座8上位于摆杆5两侧表面分别预留了十排小孔21，每排两个，如图7所示。当把侧支架拆除时，在摆杆5两侧分别放置可调距离的竖直保护架20，可以防止摆杆由于某种原因没有控制好时，倒立摆上的一些器件可能由于碰撞而摔坏，另外，通过调节竖直保护架与摆杆到距离，还可用来调节摆杆的最大偏角。

实施例四

由于本发明的系统为模块化设计，在调试过程中，如果发现CRS03-02的传感器的精度不够高，可以把摆杆组件中的CRS03-02换下，直接换上ADIS16355即可，因为在摆杆上已经预留了安装ADIDS16355的位置，且它们的接口在MTK2812板上都可以使用。

实施例五

在倒立摆系统底座的下部四个拐角处各装有一个脚轮7，是整个系统的移动装置，当移动到一个固定的位置时，可以利用脚轮7上固有的刹车装置来固定倒立摆系统的位置，以免在实验过程中影响系统的控制。如果在实际调试过程中，发现倒立摆不是很容易控制的话，也可以取掉四个脚轮7，降低倒立摆的高度，从而降低系统的重心。

Claims (7)

1.一种基于飞轮的倒立摆平衡控制系统，包括摆杆和底座，其特征在于在摆杆(5)的顶端固定一个包含有减速器的直流无刷伺服电机(4)，在电机装有旋转轴的一端装有一个能够随之一起旋转的飞轮(1)，电机的另一端与增量式编码器(13)连接；摆杆(5)的两侧安装有倾角传感器(15)和倾角速度传感器(14)；摆杆的底部通过摆杆旋转轴(9)与底座(8)上的摆杆支撑座(10)连接；底座(8)上布置有电源(19)、伺服驱动器(16)、电源转接板(18)和运动控制器(17)，其中倾角传感器(15)、倾角速度传感器(14)的输出端分别与运动控制器(17)连接，运动控制器(17)的输出端与伺服驱动器(16)连接，伺服驱动器(16)的输出端与增量式编码器(13)连接，倾角速度传感器(14)、伺服驱动器(16)、电机(4)分别由电源(15)直接供电，倾角速度传感器(14)和运动控制器(17)由电源转接板(18)将电源(15)的电压转换后供电。

2.根据权利要求1所述的一种基于飞轮的倒立摆平衡控制系统，其特征在于在摆杆(5)的两侧还对称安装有两个侧支架(6)。

3.根据权利要求1所述的一种基于飞轮的倒立摆平衡控制系统，其特征在于在底座(8)的两侧放置竖直保护架(20)。

4.根据权利要求1所述的一种基于飞轮的倒立摆平衡控制系统，其特征在于所述的飞轮(1)能够被设计成重量主要集中于圆周的形状，以提高其转动惯量。

5.根据权利要求1所述的一种基于飞轮的倒立摆平衡控制系统，其特征在于在底座(8)四角的下部分别安装有脚轮(7)。

6.根据权利要求5所述的一种基于飞轮的倒立摆平衡控制系统，其特征在于所述的脚轮(7)具有各自的刹车系统。

7.根据权利要求1所述的一种基于飞轮的倒立摆平衡控制系统，其特征在于在飞轮(1)中心套管的外部安装一个轴承(2)，以为了减小飞轮重力对电机轴的压力。

Images