燕山大学

课 程 设 计 说 明 书

题目：双轮自平衡小车机器人系统设计与制作

学院（系）：机械工程学院 年级专业：12级机械电子工程 组 号：3

学生姓名：

指导教师：史艳国 姚建涛 李艳文 史小华 张庆玲

唐艳华 李富娟 刘晓飞 刘正操 胡浩波

日 期： 2015.11

燕山大学课程设计（论文）任务书

院（系）：机械工程学院 基层教学单位：机械电子工程系

组号 设计题目 学生姓名 双轮自平衡小车机器人系统设计与制作 设 计 在课程研究项目所搭建的伺服控制系统的基础上，自主设计加工双轮车的机械系统，并完成要 智能双轮自平衡车系统装配与调试。 求 所搭建的双轮车系统需要具备以下基本功能： 技 术 参 数 a. 具备一定的自平衡能力，自动检测自身机械系统的倾角并完成姿态的调整； b. 具备一定的负载承载能力，在加载一定重量的重物时能够快速做出调整并保证自身系统的自我平衡； c. 具备速度调节能力，能够以不同的运动速度实现双轮车系统的前进、后退、左转与右转等动作； d. 具备无线通讯功能，能够实现双轮自平衡车系统的无线远程操作控制。 （1）资料分析：查阅相关文献资料，对资料进行分析总结。 （2）机器人总体设计：确定机器人的具体任务要求，根据任务初步拟定机器人的技术参数、运动形式、机械结构、驱动方案、传动方案、控制方案等。 （3）机器人机械结构设计：将机器人分解为车身结构、机械臂和手爪等若干部分，分别对工 各个结构的关键部件进行详细设计并校核，绘制机器人总装图和关键零部件图。 作 （4）传感和信息检测及信息传输：根据任务要求，完成相关信息检测、处理，并完成信息量 的正确传输。 （4）运动控制方案设计；基于传感信息，采用单片机完成机器人控制系统硬件和软件的设计和系统调试。 （5）编制课程设计说明书 （1）资料查阅、分析总结，所需天数1天 （2）总体方案设计，所需天数2天 （3）机械结构设计，所需天数2天 工 作 计 划 （4）传感、信息传输和运动控制系统的设计，所需天数2天 （5）关键零部件的设计制作，所需天数2天 （6）控制程序编码与调试，所需天数3天 （7）绘制总装图和关键零件图，所需天数2天 （8）系统整体装配与调试 所需天数3天 （9）编制课程设计说明书 所需天数2天 （10）答辩考核、演示，所需天数1天 参考 资料 通过校园网在我校订阅的电子资料库中可以搜索到大量的有关机电一体化以及电机和电力拖动的参考资料。同学们也可到学校的图书馆查找纸质期刊资料。机械学院的计算机中心上班时间免费对本院学生开放。 基层教学单位主任签字

指导教师签字

燕山大学课程设计说明书

摘要

两轮自平衡小车是一种非线性、多变量、强耦合、参数不确定的复杂系统，他体积小、结构简单、运动灵活，适合在狭小空间内工作，是检验各种控制方法的一个理想装置，受到广大研究人员的重视，成为具有挑战性的课题之一。

两轮自平衡小车系统是一种两轮左右并行布置的系统。像传统的倒立一样，其工作原理是依靠倾角传感器所检测的位姿和状态变化率结合控制算法来维持自身平衡。本设计通过对倒立摆进行动力学建模，类比得到小车平衡的条件。从加速度计和陀螺仪传感器得出的角度。运用卡尔曼滤波优化，补偿陀螺仪的漂移误差和加速度计的动态误差，得到更优的倾角近似值。通过光电编码器分别得到车子的线速度和转向角速度，对速度进行PI控制。根据PID控制调节参数，实现两轮直立行走。通过调节左右两轮的差速实现小车的转向。

制作完成后，小车实现了在无线蓝牙通讯下前进、后退、和左右转向的基本动作。此外小车能在正常条件下达到自主平衡状态。并且在适量干扰下，小车能够自主调整并迅速恢复稳定状态。

关键词： 自平衡 陀螺仪 控制调试

I