飞思卡尔智能车报告.ppt

第七届“飞思卡尔”智能车电磁组学习报告 2011级电子二班：史一帆 第一部分 ：方案设计 智能车系统的总体设计思路，将整个系统分为三大部分，机械结构、控制模块、控制算法等三部分，如下图所示。 第二：原理部分 直立行走任务分解 电磁组比赛要求车模在直立的状态下以两个轮子着地沿着赛道进行比赛，相比四轮着地状态，车模控制任务更为复杂。为了能够方便找到解决问题的办法，首先将复杂的问题分解成简单的问题进行讨论。为了分析方便，根据比赛规则，假设维持车模直立、运行的动力都来自于车模的两个后车轮，后轮转动由两个直流电机驱动。因此从控制角度来看，由控制车模两个电机旋转方向及速度实现对车模的控制。车模运动控制任务可以分解成以下三个基本任务： （1） 控制车模直立：通过控制两个电机正反向运动保持车模直立状态； （2） 控制车模速度：通过控制两个电机转速速度实现车模行进控制； （3） 控制车模转向：通过控制两个电机之间的转动差速实现车模转向控制。 可以假设车模的电机可以虚拟地被拆解成三个不同功能的驱动电机，它们同轴相连，分别控制车模的直立平衡、前进行走、左右转向，如下图所示。 。 在上述三个任务中保持车模直立是关键。由于车模同时受到三种控制的影响，从车模直立控制的角度，其它两个控制就成为它的干扰。因此在速度、方向控制的时候，应该尽量平滑，以减少对于直立控制的干扰。 车模直立控制的原理 控制车模直立的直观经验来自于杂技表演。一般的人通过简单练习就可以让一个直木棒在手指尖上保持直立。这需要两个条件：一个是托着木棒的手掌可以移动；另一个是眼睛可以观察到木棒的倾斜角度和倾斜趋势（角加速度）。通过手掌移动抵消木棒的倾斜角度和趋势，从而保持木棒的直立。世界上还没有任何一个天才杂技演员可以蒙着眼睛使得木棒在自己手指上直立，因为没有了负反馈。 车模直立也是通过负反馈实现的。但相对于上面的木棒直立相对简单。因为车模有两个轮子着地，因此车体只会在轮子滚动的方向上发生倾斜。控制轮子转动，抵消倾斜的趋势便可以保持车体直立了。 车模速度控制 车模运行速度是通过控制车轮速度实现的，车轮通过车模两个后轮电机经由减速齿轮箱驱动，因此通过控制电机转速可以实现对车轮的运动控制。 （1） 通过电机加速度控制实现车模直立稳定。 （2）通过电机速度控制，实现车模恒速运行和静止。虽然本届比赛规则中没有要求车模速度恒定，也没有要求车模在比赛之前和冲过终点之后保持静止状态。但是通过速度控制，可以提高车模稳定性。在将来的比赛中，如果规则增加了静止要求，或者需要通过路桥等障碍，速度控制将会发挥作用。 （3）通过电机差速控制，可以实现车模方向控制。电机运动控制是通过改变施加在其上的驱动电压实现的。对于电机的电磁模型、动力学模型以及车模的动力学模型进行分析和简化，可以将电机运动模型简化成如下的一阶惯性环节模型。施加在电机上一个阶跃电压，电机的速度变化曲线为： 电机的速度变化曲线如图 电机运动明显分为两个阶段 电机运动明显分为两个阶段：第一个阶段是加速阶段；第二个阶段为恒速阶段。其中，在加速阶段，电机带动车模后轮进行加速运动，加速度近似和施加在电机上的电压成正比，加速阶段的时间长度取决于时间常数，该常数由电机转动惯量、减速齿轮箱、车模的转动惯量决定；在恒速阶段，电机带动车模后轮进行恒速运行，运行速度与施加在电机上的电压成正比。调整车模直立时间常数很小，此时电机基本上运行在加速阶段。计算所得到的加速度控制量a再乘以一个比例系数，即为施加在电机上的控制电压，这样便可以控制车模保持直立状态。车模运行速度调整时间相对很长，此时，电机速度与施加在其上的电压成正比。通过传统的PID反馈控制，便可以精确控制电机的运行速度，从而控制车模的运行速度。电机速度控制需要测量电机的转速，电机旋转速度可以通过安装在电机输出轴上的光电编码盘方便获 车模方向控制 （1） 道路电磁中心线的偏差检测 道路电磁中心线检测简单的方法可以通过安装在车模前方的两个电磁感应线圈实现。线圈一般采用10mH的工字型电感。 （2） 电机差动控制 利用电磁线偏差检测信号分别与车模速度控制信号进行加和减，形成左右轮差动控制电压，使得车模左右轮运行角速度不一致进而控制车模方向，如下图所示。 车模直立行走控制算法总图 第三部分：机械设计 传感器安装 车模中的传感器包括有：速度传感器，车模姿态传感器（陀螺仪、加速度计）以及电磁检测感应线圈。 （1）速度传感器安装 速度编码器我们采用了编码器，安装方法如下： 用十字扳手套筒将车的后轮拆卸后，安装编码器，固定编码器的固定件是根据车得尺寸及与编码器的相对位置手工制作的连接固定件。固定件的尺寸如图所示。 　　电磁传感器安装 　　为了减少小车转向时的转动的转动惯量，应尽量减小传感器支架的重量，同时应保证传感器