单片机课程设计21429.docxVIP

湖南大学电气与信息工程学院 本科生单片机课程设计报告 课 题:光电平衡小车 专业班级:电自六班 姓 名: 余梦琪 学 号:20100710622 指导教师: 唐求 目录 TOC \o 1-3 \h \z \u HYPERLINK \l _Toc332541979 第一章 车模整体设计方案 3 HYPERLINK \l _Toc332541980 1.1两轮自平衡智能车整体框架 3 1.2直立任务分解……………………………………………………………………………..5 1.3车模直立控制……………………………………………………………………………..9 1.4车模速度控制……………………………………………………………………………10 1.5车模方向控制……………………………………………………………………………10 HYPERLINK \l _Toc332542003 第二章程序控制说明 11 HYPERLINK \l _Toc332542004 2.1主程序框架 11 HYPERLINK \l _Toc332542004 6.1电机死区补偿 12 HYPERLINK \l _Toc332542005 6.2角度单闭环控制 13 HYPERLINK \l _Toc332542006 6.3角度、速度双闭环控制 14 HYPERLINK \l _Toc332541982 第二章 车模机械设计 15 HYPERLINK \l _Toc332541983 3.1车模地盘安装 15 HYPERLINK \l _Toc332541984 3.2车模编码器安装 15 HYPERLINK \l _Toc332541985 3.3车模电池位置改装 16 HYPERLINK \l _Toc332541990 第三章 车模硬件电路设计 18 HYPERLINK \l _Toc332541997 第四章 卡尔曼滤波 18 HYPERLINK \l _Toc332541998 4.1卡尔曼滤波简介 18 HYPERLINK \l _Toc332541999 4.2使用卡尔曼滤波的原因 18 HYPERLINK \l _Toc332542000 4.3卡尔曼滤波原型 20 HYPERLINK \l _Toc332542001 4.4卡尔曼滤波化简 21 HYPERLINK \l _Toc332542002 4.5卡尔曼滤波参数整定 23 HYPERLINK \l _Toc332542007 第五章车模参数调试图解 29 HYPERLINK \l _Toc332542015 附录源代码 30 附录硬件电路图 HYPERLINK \l _Toc332542007 30 个人总结 HYPERLINK \l _Toc332542014 30  车模整体设计方案 1.1两轮自平衡智能车整体框架 智能车是在车模结构的框架上，搭上硬件结构，通过MC9S12XS128单片机的处理能力，将传感器采集到的信息处理分析后得出运算结果，指挥电机做出适应赛道及战术策略的响应的一套系统。其硬件结构框架如下图： 电源模块 电源模块 S12XS128控制核心单片机 加速度计模块 控制器模块 CCD路径检测 测速模块 陀螺仪模块 电机驱动模块 1.2 直立行走任务分解 电磁组比赛要求车模在直立的状态下以两个轮子着地沿着赛道进行比赛，相比四轮着地状态，车模控制任务更为复杂。为了能够方便找到解决问题的办法，首先将复杂的问题分解成简单的问题进行讨论。为了分析方便，根据比赛规则，假设维持车模直立、运行的动力都来自于车模的两个后车轮，后轮转动由两个直流电机驱动。因此从控制角度来看，由控制车模两个电机旋转方向及速度实现对车模的控制。车模运动控制任务可以分解成以下三个基本任务： （1） 控制车模直立：通过控制两个电机正反向运动保持车模直立状态； （2） 控制车模速度：通过控制两个电机转速速度实现车模行进控制； （3） 控制车模转向：通过控制两个电机之间的转动差速实现车模转向控制。 以上三个任务都是通过控制车模两个后轮驱动电机完成的。可以假设车模的电机可以虚拟地被拆解成三个不同功能的驱动电机，它们同轴相连，分别控制车模的直立平衡、前进行走、左右转向，如图2.1所示。 图 2.1 车模运动控制分解示意图 直流电机的力矩最终来自于电机驱动电压产生的电流。因此只要电机处于线性状态，上述拆解可以等效成三种不同控制目标的电压叠加之后，施加在电机上。 在上述三个任务中保持车模直立是关键。由于车模同时受到三种控制的影响，从车模直立控制的角度，其它两个控制就成为它的干扰。因此在速度、方向控制的时候，应该尽量平滑，以减少对于直立控制的干扰。三者之间的配合如图2.