《学士学位论文--基于pid控制器的两轮自平衡小车设计.doc》由会员分享,可在线阅读,更多相关《学士学位论文--基于pid控制器的两轮自平衡小车设计.doc(32页珍藏版)》请在金锄头文库上搜索。
1、本科毕业设计基于PID控制器的两轮自平衡小车设计摘 要两轮自平衡小车具有体积小、结构简单、运动灵活的特点,适用于狭小和危险的工作空间,在安防和军事上有广泛的应用前景。两轮自平衡小车是一种两轮左右平衡布置的,像传统倒立摆一样,本身是一种自然不稳定体,其动力学方程具有多变量、非线性、强耦合、时变、参数不确定性等特性,需要施加强有力的控制手段才能使其保持平衡。本文在总结和归纳国内外对两轮自平衡小车的研究现状,提出了自己的两轮自平衡小车软硬件设计方案,小车硬件采用陀螺仪和加速度传感器检测车身的重力方向的倾斜角度和车身轮轴方向上的旋转加速度,数据通过控制器处理后,控制电机调整小车状态,使小车保持平衡。由
2、于陀螺仪存在温漂和积分误差,加速度传感器动态响应较慢,不能有效可靠的反应车身的状态,所以软件使用互补滤波算法将陀螺仪和加速度传感器数据融合,结合陀螺仪的快速的动态响应特性和加速度传感器的长时间稳定特性,得到一个优化的角度近似值。文中最后通过实验验证了自平衡小车软硬件控制方案的可行性。关键词:自平衡 互补滤波 数据融合 倒立摆Two-wheeled Self-balancing RobotMa Xuedong(College of Engineering, South China Agricultural University, Guangzhou 510642, China)Abstract:
3、The two-wheeled self-balancing robot is small in mechanism, with simple structure and can make flexible motion, suitable for narrow and dangerous work space. So it has wide range of applications in security and military. The two-wheeled self-balancing robot is a natural unstable system. The device o
4、f this system is a parallel arrangement of two single wheels, like a traditional inverted pendulum. Its dynamics are multi-variable, non-linear, serious coupling and uncertain parameters etc. It must be exerted strong control to make it stable.In this paper, studies on two-wheel self-balancing vehic
5、le at home and abroad are summarized. We designed the hardware and software of our two-wheel self-balancing vehicle. The car using rotational accelerometers, gyroscopes and acceleration sensors to detect body condition and the state in which the pitch change rate. The central processing unit calcula
6、te the appropriate data and instructions, and control the motor to achieve the body balancing. Because of gyro drift problems and Integral error with accelerometers and slow dynamic response of acceleration sensors. It cant provide effective or reliable information to reflect the real state of its b
7、ody. So we using complementary filter to fuse the data of two sensors, so that the inclination of its body can be approximated better.Finally, we verified the feasibility of the systems hardware and software through experiment.Key Words: Self-Balancing complementary filter Data Fusion Inverted Pendu
8、i目 录1 前言11.1 研究意义11.2 国内外研究现状11.2.1 国外研究成果11.2.2 国内研究成果11.3 本文的研究内容22 两轮平衡车的平衡原理22.1 平衡车的机械结构22.2 两轮车倾倒原因的受力分析32.3 平衡的方法33 系统方案分析与选择论证43.1 系统方案设计43.1.1 主控芯片方案43.1.2 姿态检测传感器方案43.1.3 电机选择方案53.2 系统最终方案54 主要芯片介绍和系统模块硬件设计64.1 加速度传感器ADXL34564.2 陀螺仪传感器L3G4200D84.3 主控电路104.4 电机驱动电路114.5 供电电路115 系统软件设计125.1
9、系统初始化135.2 滤波器145.2.1 低通滤波器155.2.2 互补滤波器155.3 PID控制器175.3.1 PID概述175.3.2 数字PID算法175.3.3 PID控制器设计186 硬件电路196.1 硬件制作与调试196.2 硬件调试结果196.2.1 姿态感知系统测试结果196.2.2 PID控制器测试结果207 结论21参考文献23附录24致谢26华南农业大学本科生毕业设计成绩评定表II1 前言1.1 研究意义应用意义。自平衡车巧妙地利用地心引力使其自身保持平衡,并使得重力本身成为运动动能的提供者,载重越大,行驶动能也就越大,具有环保的特点(胡春亮等,2007)。驾驶者
10、不必担心掌握平衡,车体自身的平衡稳定性,使得原本由于平衡能力障碍而无法骑自行车的人群也同样可以驾驭。车身小巧,转弯灵活,可以在狭窄、大转角的工作场合作业。自平衡车的种种优点使其可以作为一种快速、环保、安全、舒适、小巧灵活的绿色交通工具,是未来汽车和自行车的替代品,其市场的广阔性与经济效益不言而喻。理论研究意义。自平衡车,在重力作用下车体姿态本征不稳定,需要电机的控制来维持姿态的平衡,通过电机驱动转动车轮,传感器、软件、微处理器及车体机械装置整体协调控制电动车平衡,是集环境感知、动态决策与规划、行为控制与执行等多种功能于一体的综合复杂非线性系统,其控制难度大,控制算法复杂,给控制理论提出了很大的
11、挑战,具有较强的理论研究价值。1.2 国内外研究现状美国、日本、瑞士等国家在研究自平衡车领域起步较早,目前已经达到了先进的水平。国内的一些高校以及科研机构也对其有所研究,并取得了一定的成绩。1.2.1 国外研究成果美国Lego公司Steve Hassenplug设计了两轮自平衡传感式机器人Legway。实现了电机差动驱动方式,遥控操作,可以向前,向后和转弯时保持平衡,可以实现U型回转和零半径转弯。Legway是第一个自平衡机器人。采用了模块化的结构设计,安装和拆卸都很方便。日本村田制作所的科学家研发了骑独轮车的机器人“村田顽童”和“村田婉童”。保持左右平衡通过转动机器人体内配备的惯性轮来实现。
12、瑞士联邦工学院的工业电子实验室为模拟人类行走设计并制造了一个基于倒立摆理论的两轮小车,该小车使用DSP控制,车架上方附有重物模拟实际车中的驾驶员,该小车使用陀螺仪和电机编码器得到的信息来稳定系统。1.2.2 国内研究成果哈尔滨工业大学设计的HITBot两轮自平衡小车,采用Accodometry方法,通过融合码盘和加速度级数据对位置进行估计,有效解决了两轮自平衡小车在运行过程中遇到打滑、越障、碰撞等异常事件而导致的位置估计失败的问题,解决了非系统测程法误差对机器人位置估计的影响,降低了加速度级固有漂移的不利影响,提高了两轮自平衡车的定位精度。深圳职业技术学院等设计的两轮自平衡小车Opyanbot
13、,应用最优控制与两轮差动等控制方法设计了控制器,提出了针对两轮自平衡机器人平衡和行进的新策略。为了提高两轮自平衡机器人的控制效果,利用基于DSP数字电路的全数字智能伺服驱动单元IPM100分别精确控制左右轮电机,并利用上位机实时控制机器人的运动状态,提高了控制精度、可靠度和集成度,得到了很好的控制效果。1.3 本文的研究内容本文研究内容有两轮自平衡小车的姿态检测算法,PID控制算法两方面。姿态检测算法通过互补滤波器融合姿态传感器(加速度传感器和陀螺仪传感器)数据,得到小车准确稳定的姿态信息,PID调节器则利用这些姿态信息,输出电机控制信号,控制电机的转动,使小车得以平衡。2 两轮平衡车的平衡原
14、理2.1 平衡车的机械结构图1 平衡车机械结构现有的自平衡车结构种类繁多,但都归根于图1的基本结构,因此,本设计将使用图1的结构,车体由三层组成,从上到下依次是电池层,主控层,电机驱动层,电池层用于放置给整个系统供电的6V锂电池,主控层由主控芯片最小系统和传感器模块组成,电机驱动层接受单片机信号,并控制电机。每个层都是功能模块的电路路板之间用铜柱固定,电机外壳与电机驱动电路板固定,电机转轴与两只轮胎相连。2.2 两轮车倾倒原因的受力分析两轮车是一个高度不稳定系统,在重力作用下车体姿态本征不稳定,致使在没有外加调控下必然倾倒的现象(张三川,2011)。其受力如图2所示。 图2 平衡车受力分析图理
15、想状态下,当M(车体重力)的方向与H(车轮支持力)的方向相差180时,系统此时受力平衡,可以达到稳定不倒的状态,角度为0。但自然界存在各式各样的干扰,角度总不为0,只要产生角,即使角度很小,M的方向与H的方向亦产生了角度,合力不为0,根据牛顿运动定律可知,角度将越来越大,直至车体倾倒在地上。2.3 平衡的方法从以上分析可得,导致车体倾倒的最大因素是角度的产生,因此,欲使小车平衡,需要消除或者将角度控制在一个足够小的范围内。其整体控制环路图3所示。 图3 小车平衡原理流程图消除角度的有效方法,是通过电机的转动,带动车体下部的移动,以保持与车体上部在一水平垂直线上。 3 系统方案分析与选择论证3.1 系统方案设计3.1.1 主控芯片方案方案一:采用意