大学生创新创训业练计划项目中期进展报告.doc

大学生创新创业训练计划项目中期进展报告 （3000字，小四宋体 项目成员： 高超、孙健陈伟张波 摘 要： 项目成果简介： 1、为了验证在做实体之前对传感器的使用和芯片编程等有充足的把握，我们已经完成了一个车体模型的测试工作。 2、为了直观的了解车体的结构和便于让团队个成员加入自己的创意，我们初步设计了车体的机械结构，并用Solidworks建模。 项目进展： 我们最初的项目计划中的写的是总共分五步走，现在才刚刚10月下旬，我们已经完成了前面三步，其中包括3月-5月完成主控芯片程序设计；6月-7月电路设计；7月-8月搭建车车模对电路，程序进行测试；可以说比我们当年预期的进度提前了。 已经取得成果： 成果主要有两方面： 一是车体模型测试，我们主控芯片是采用飞思卡尔的k60系列芯片，JTAG下载器，角度传感器，直流电机，2600mah的锂电池，L7805稳压芯片，BTN7971B电机驱动。测试说明程序和电路的可行性，初步验证了理想的方案的可行性。具体设计方案如下：1、车模的平衡控制原理：当车体垂直时，车轮保持静止，车体向左倾斜时，车轮向左加速运行，车体向右倾斜时，车轮向右加速运行。直立的车模可以看成是放置在可以左右移动平台上的倒立摆的单摆。普通单摆能够稳定在垂直位置的条件有两个：（1）受到与位移（角度）相反的恢复力；（2）受到与运动速度（角速度）相反的阻尼力。如果没有阻尼力，单摆会在垂直位置左右摆动。阻尼力会使单摆最终停止在垂直位置。阻尼力过小（欠阻尼）会使单摆在平衡位置附近来回震荡。阻尼力过大（过阻尼）会使单摆达到平衡位置的时间加长。因而存在一个临界阻尼系数，是得单摆稳定在平衡位置的时间最短。倒立摆之所以不能像单摆一样稳定在垂直位置，就是因为它在偏离平衡位置的时候，所受到的恢复力与位移的方向相同，而不是相反，因此，倒立摆会加速偏离垂直位置，直至倒下。为了通过控制使得倒立摆能够像单摆一样稳定在垂直位置，需要增加额外的受力，使得恢复力与位移方向相反才行。该力与车轮的加速度的方向相反，大小成正比。为了是倒立摆尽快在垂直位置稳定下来，还需要增加阻尼力，增加的阻尼力与偏角的速度成正比，方向相反。综上可以得到车轮控制速度的算法为：a = k1θ+k2 θ’;式中θ为车模倾角θ’为角速度k1，k2均为比例系数。K1决定了车模是否能够稳定在垂直位置，它必须大于中立加速度，k2决定了车模回到垂直位置的阻尼系数，选取合适的阻尼系数可以让车模尽快稳定在垂直位置。 车模的加速度是通过控制车轮速度实现的，车轮通过车模因此两个可以通过电机加速度的控制实现车模平衡稳定。电机的运动控制是通过改变施加在其上的驱动电压大小实现的。电机的运动分为两个阶段，第一个是加速阶段，第二个是恒速阶段。在加速阶段，电机带动车模进行加速运动，加速度和施加在电机上的电压成正比。在恒速阶段，电机带动车模后轮进行恒速运动，运行速度与施加在电机上的电压成正比。调整车模角度的控制周期很短，时间一般是几个毫秒，此时电机基本运动在家阶段，计算得到加速度控制量a在乘上比例系数即为施加在电机上的控制电压，这样便可以控制车模保持直立状态。 加速度传感器MMA761可以测量由地球引力作用或者物体运动产生的加速度，只需测量其中一个方向上的加速度值，皆可以计算出车模的倾角，比如使用z轴方向上的加速度信号。车模直立时，固定在加速度在z轴水平方向，此时输出信号为0片区内压信号。当车模发生倾斜=时，重力加速度g便会在z轴方向上新城加速度分量，从而引起该轴输出电压的变化。但是在实际车模运动中，由于车模本身的摆动所产生的加速度会产生很大的干扰信号，它叠加在测量信号汇总使得输出信号无法准确反映车模的倾角。加速度传感器安装的高度越低越好，但是无法彻底消除车模运送的影响。 角速度传感器利用旋转坐标系中的物体会受到科里奥利力的原理可以用来测量物体的旋转角速度，通过积分便可以得到车模的倾角。由于陀螺仪输出的是车模的角速度，不会收银岛车体运动的影响，因此该信号中噪声很小。车模的角度又是通过对角速度积分而得，这可进一步平滑信号，从而使得角度信号更加稳定。因此车模控制所需要的角度和角速度可以使用陀螺仪所得到的信号。但是由于从陀螺仪角速度获得角度信息，需要经过积分运算。如果角速度信号存在微小的偏差和漂移，经过积分运算之后，变化形成积累误差。这个误差会随着时间延长逐步增加，最终导致电路饱和，无法形成正确的角度信号。一种简单的方法就是通过上面的加速度传感器获得的角度信息对此进行校正。通过对比积分所得到的角度与重力加速度所得到的角度，使用它们之间的偏差改变陀螺仪的输出，从而积分的角度足部跟踪到加速度传感器所得到的角度。 二是实体车体的Solidworks模型，这个参考了市场上已有车型的结构和自己的创意，这只是