两轮自平衡小车.doc

两轮自平衡小车1简介两轮自平衡小车是一种特殊轮式移动机器人,其动力学系统具有多变量、非线性、强耦合、参数不确定等特性。是一个集动态决策和规划、环境感知、行为控制和执行等多种功能于一体的综合复杂系统,其关键是在解决自平衡的同时,还能够适应在各种环境下的控制任务。通过运用外加速度传感器、角速度传感器等,可以实现小车的平衡自主前进。两轮自平衡小车,涉及到传感器的驱动,数据的处理,角度的计算,电机的控制等,内容比较丰富。其原理看似简单,但谁都不能小看它,它绝对当得上“精妙”二字。近年来它的应用已较为普遍,研究也较为深刻。由于它具有体积小、运动灵活、零转弯半径等特点,将会在军用和民用领域有着广泛的应用前景。因为它既有理论研究意义又有实用价值,所以两轮自平衡小车的研究在最近十年引起了大量机器人技术实验室的广泛关注。:(1)  前倾状态:即车身重心靠前,车身会向前倾斜,则驱动车轮向前滚动,以保持小车平衡。(2)  静止状态:即车身重心位于电机轴心线的正上方,则小车将保持动态平衡静止状态,不需要做任何控制。(3)  后仰状态:即车身重心靠后,车身会向后倾斜,则驱动车轮向后滚动,以保持小车平衡。(4)  因此,两轮自平衡小车平衡控制的基本思想是:是系统以姿态传感器(陀螺仪、加速度计)来监测车身所处的俯仰状态和状态变化率,通过高速中央处理器计算出适当数据和指令后,控制系统会根据测得的倾角产生一个相应的力矩,通过控制电机驱动两个车轮朝车身要倒下的方向运动,以保持小车自身的动态平衡。其图如下;(1)前倾(2)静止(3):传感器、控制器、执行器。两轮自平衡小车也是由这三部分组成。其结构原理如下:图2-1系统硬件结构图此外通常会加上硬件抗干扰措施。,需要快速、准确地获得机器人的位置与姿态信息,这是控制两轮自平衡小车平衡与运动的前提条件,为此我们需要传感器。对于小车姿态检测而言,我们一般采用惯性传感器。一般常用的惯性传感器有加速度计、陀螺仪以及倾斜传感器。而三种传感器各有优缺点,综合经济、实用等方面的考虑,我们选用加速度计和陀螺仪。下面是两种传感器基本信息的比较:表3-1两种传感器基本信息比较传感器加速度计陀螺仪测量量加速度角速度优点静态性能好动态性能好缺点动态相应慢,不适合跟踪动态角速度运动存在积累漂移误差,不适合长时间单独工作   综合上述信息,两者加起来是最优搭配,具有互补作用。此外我们还要添加一个光电编码器。编码器的主要作用是采集车轮的运动信息,以便微控制器的决策;光电编码器用以检测小车的位移,同时对位移求导可以得到小车的速度。但一般来说电机中自带的霍尔元件也有部分功能。,要有优秀的硬件及驱动线路和同样优秀的算法软件。一般的驱动线路图如下:图3-1电机控制原理图其中的细节部分不再展开来讲。再者就是软件算法。算法是计算机的灵魂,因此算法在此两轮自平衡小车中也是起到灵魂的作用。这