两轮自平衡小车控制系统的设计

　　摘 要： 介绍了两轮自平衡小车控制系统的设计与实现，系统以飞思卡尔公司的16位微控制器MC9S12XS128MAL作为核心控制单元，利用加速度传感器MMA7361测量重力加速度的分量，即小车的实时倾角，以及利用陀螺仪ENC-03MB测量小车的实时角速度，并利用光电编码器采集小车的前进速度，实现了小车的平衡和速度控制。在小车可以保持两轮自平衡前提下，采用摄像头CCD-TSL1401作为路径识别传感器，实时采集赛道信息，并通过左右轮差速控制转弯，使小车始终沿着赛道中线运行。实验表明，该控制系统能较好地控制小车平衡快速地跟随跑道运行，具有一定的实用性。

　　关键词： 控制；自平衡；实时性

　　近年来，随着经济的不断发展和城市人口的日益增长，城市交通阻塞以及耗能、污染问题成http://www.dgfpc.com/电感厂家为了一个困扰人们的心病。新型交通工具的诞生显得尤为重要，两轮自平衡小车应运而生，其以行走灵活、便利、节能等特点得到了很大的发展。但是，昂贵的成本还是令人望而止步，成为它暂时无法广泛推广的一个重要原因。因此，开展对两轮自平衡车的深入研究，不仅对改善平衡车的性价比有着重要意义，同时也对提高我国在该领域的科研水平、扩展机器人的应用背景等具有重要的理论及现实意义。全国大学生飞思卡尔智能车竞赛与时俱进，第七届电磁组小车首次采用了两轮小车，模拟两轮自平衡电动智能车的运行机理。在此基础上，第八届光电组小车再次采用两轮小车作为控制系统的载体。小车设计内容涵盖了控制、模式识别、传感技术、汽车电子、电气、计算机、机械及能源等多个学科的知识。

　　1 小车控制系统总体方案

　　小车以16位单片机MC9S12XS128MAL作为中央控制单元，用陀螺仪和加速度传感器分别检测小车的加速度和倾斜角度[1]，以线性CCD采集小车行走时的赛道信息，最终通过三者的数据融合，作为直流电机的输入量，从而驱动直流电机的差速运转，实现小车的自动循轨功能。同时，为了更方便、及时地观察小车行走时数据的变化，并且对数据作出正确的处模压电感理，本系统调试时需要无线模块和上位机的配合。小车控制系统总体架构如图1所示。

　　2 小车控制系统自平衡原理

　　两轮小车能够实现自平衡功能，并且在受到一定外力的干扰下，仍能保持直立状态，是小车可以沿着赛道自动循线行走的先决条件。为了更好地控制小车的行走方式，得到最优的行走路径，需要对小车分模块分析与控制。

　　本控制系统维持小车直立和运行的动力都来自小车的两个轮子，轮子转动由两个直流电机驱动。小车作为一个控制对象，它的控制输入量是两个电机的转动速度。小车运动控制可以分解成以下3个基本控制任务。

　　（1）小车平衡控制：通过控制两个电机正反方向运动保持小车直立平衡状态；

　　（2）小车速度控制：通过调节小车的倾斜角度来实现小车速度控制，本质上是通过控制电机的转速来实现小车速度的控制。

　　（3）小车方向控制：通过控制两个电机之间的转动差速实现小车转向控制。

　　2.1 小车平衡控制

　　要想实现小车的平衡控制，需要采取负反馈控制方式[2]。当小车偏离平衡点时，通过控制电机驱动电机实现加、减速，从而抵消小车倾斜的趋势，便可以保持车体平衡。即当小车有向前倾的趋势时，可以使电机正向加速，给小车一个向前的加速度，在回复力和阻尼力的作用下，小车不至于向前倾倒；当小车有向后倾的趋势时，可以使小车反向加速，给小车一个向后的加速度，从而不会让小车向后倾倒，如图2所示。

　　从上述的定性分析可知，在运动过程中小车会不断地在平衡点附近来回摆动，如果控制不当，来回摆动的幅度会很大。显然，这样的控制不能满足两轮小车的实际要求，小车更无法按照赛道快速运行。为使小车可以在平衡点附近很好地保持平衡，需要对小车的加速度等进行严格地定量分析和计算。

DSP实现3G LTE应用技术简介3G LTE是第三代伙伴计划(3GPP)的一个高级标准，为广域网提供下一代宽带无线技术。 与以前各阶段的3GPP相比，3G LTE的目标是更高的吞吐量、更低的时延以及高效的IP回程，提供一种新的可以大

一种200V/100A VDMOS 器件开发 摘 要：分析了功率MOSFET 最大额定电流与导通电阻的关系，讨论了平面型中压大电流VDMOS器件设计中导通电阻、面积和开关损耗的折衷考虑，提出了圆弧形沟道布局以增大沟道宽度，以及栅氧下部分非沟道区

变流负荷供电线路电压暂降的治理研究摘要：以变流装置驱动的敏感负荷对供电质量要求较高，供电电压质量中存在的电压暂降，可造成调速电机群停事故，所带来的经济损失常在数以百万元以上。结合某拉丝生产工艺线治理电压暂降，消除生产隐患的需求研制出一

 1/3    1 2 3 下一页 尾页