电子设计-电动车跷跷板
- 格式:doc
- 大小:347.50 KB
- 文档页数:12
第24卷 第2期 电子测量与仪器学报 Vol. 24 No. 2 2010年2月JOURNAL OF ELECTRONIC MEASUREMENT AND INSTRUMENT· 179 ·本文于2009年6月收到。
*基金项目: 上海理工大学博士启动基金项目。
DOI: 10.3724/SP.J.1187.2010.00179电动车跷跷板自平衡系统设计*夏 鲲 张振国 丁 学 陈建强(上海理工大学光电信息与计算机工程学院电气系, 上海 200093)摘 要: 采用32位ARM 芯片LPC2138作为MCU, 由AccuStar 电子倾角传感器获得的角度信号经移动平均滤波法作数字滤波构成检测信号, 用步进电动机作为控制驱动装置, 形成增量式闭环数字PID 控制系统,使电动小车能自动完成在不同条件下于跷跷板上保持平衡的控制任务.实验结果表明, 该系统在板长为1.6 s 时, 初次平衡响应时间小于65 s, 二次平衡响应时间小于60 s, 平衡位置与水平位置偏差小于1.1°。
关键词: AccuStar 电子倾角传感器; 数字PID; 移动平均滤波法; 步进电动机 中图分类号: TP272 文献标识码: A 国家标准学科分类代码: 470.4017Design for the electric car and teeterboardself-balanced systemXia Kun Zhang Zhenguo Ding Xueming Chen Jianqiang(University of Shanghai for Science and Technology, Shanghai, 200093)Abstract: The 32-bit ARM chip LPC2138 was applied as the MCU and the stepper motor was used as the driven device. The angle signals derived from the AccuStar electronic inclinometer by using moving average digital filter helped to accomplish the closed loop digital PID control system and keep the balance of the teeterboard under different conditions. The experiment results show that when the length of the teeterboard is 1.6 meter, the first balance costs less than 65 seconds, the second balance costs less than 60 seconds and the deviation between the balance point and the horizontal position is less than 1.1 degree.Keywords: AccuStar electronic inclinometer; digital PID; moving average digital filter; stepper motor1 引 言移动机器人的姿态控制技术在诸如航空、航海等许多领域有着广泛的应用, 各种类型的数字倾角传感器应运而生[1-2]。
龙源期刊网
基于单片机AT89S52的电动车跷跷板设计作者:贾丽霞
来源:《现代电子技术》2012年第23期
摘要:该文通过采用AT89S52作为控制核心,设计了整个电动车跷跷板系统。
系统的硬件部分主要包括:电机驱动模块、步进电动机、平衡检测模块、光电检测模块、液晶显示模块以及红外遥控模块;软件部分则采用高效的C语言编写实现了平衡检测和校正功能。
总体来说,系统的设计符合要求,可以在规定的时间内达到平衡状态。
关键词:电动车跷跷板;AT89S52;平衡检测;角度传感器
中图分类号:TN911.7-34文献标识码:A文章编号:1004-373X(2012)23-0132-03。
电动车跷跷板设计任务:设计并制作一个电动车跷跷板,在跷跷板起始端A一侧装有可移动的配重。
配重的位置可以在从始端开始的200mm~600mm范围内调整,调整步长不大于50mm;配重可拆卸。
电动车从起始端A出发,可以自动在跷跷板上行驶。
电动车跷跷板起始状态和平衡状态示意图分别如图1和图2所示。
设计思路:因为小车要在跷跷板上自动寻找平衡点所以要有一个平衡装置当小车倾斜时小车就会向前或后走的地方走而达到平衡。
因为翘翘板的宽度较小所以要小车按固定的直线行走,小车要时刻记时所以用电子显示装置计时。
基本设计(1)平衡部分因为小车在板上寻找平衡点所以要用到平衡装置有以下三个方案方案一:利用SCA100T传感器。
SCA100T优点:(1)双轴倾角传感器。
(2)测量范围0.5g或者1g。
(3)单极5伏供电,比例电压输出。
(4)长期稳定性非常好。
(5)高分辨率,低声,工作温度范围广。
缺点:灵敏度太高,价格昂贵,抗干扰能力差。
方案二:利用水银开关。
优点:(1)价格低,容易买到。
(2)制作方便,操控性好。
(3)工作范围广缺点:不稳定,水银液体不太容易控制。
方案三:利用旋转型可调电阻和铅坠。
优点:(1)价格低,容易组装。
(2)操控性好,灵敏度高。
(3)可以利用电阻的变化算出倾斜角。
缺点:有摩擦影响,受外界影响。
综上所述:经比较方案三比较好实验室中可以找到所用器材,可以通过电阻的变化算出倾角,价格较为便宜。
方案三的具体方法:首先将可变电阻的旋钮与铁杆连接起来,铁杆的另一端是较重的铅锤。
当小车的倾角变化时由于铅锤的重力作用在小车的带动下可变电阻的阻值产生变化,电压或电流发生变换传给单片机从而控制小车来找平衡点。
平衡装置原理图:(2)小车寻路装置:方案一启发:利用小车红外向寻路装置,可以让小车沿黑线在桥面上行走,当小车找到平衡点时小车自动停止,当小车到达桥的尽头是黑线消失小车停止倒行,这样可以防止小车一直沿直线行走能掉下桥。
方案二可以在小车两侧按上传感装置让小车不能掉下桥去。
57科技资讯 S CI EN CE & T EC HNO LO GY I NF OR MA TI ON 工 业 技 术1 设计任务与要求1.1设计任务在给定条件的翘翘板上,小车主要完成从一端出发行驶至平衡点附近,停留一定的时间后开始寻找平衡点,达到平衡点之后行驶至终点,停留一定的时间后返回终点。
如图1所示。
2 方案比较与论证2.1各种方案比较与选择电机选择:为实现小车的运动,还有完成跷跷板的平衡调节,电机应该具有较好的灵敏度和动力。
方案一:直流电机,直流电机响应比较快,调节起来比较方便,价格也比较便宜,可以实现高速的选择。
但是力矩有一定的限制。
方案二:减速电机,减速电机驱动能力强,制动性也好,调节平衡比较方便,但是响应比较慢。
通过实践,直流电机速度快但是动力不强,制动性比较差,不能较好的实现平衡的调节,减速电机虽然反应慢,但是可以满足平衡的调节要求,因此选择减速电机。
倾角测量传感器:倾角是小车运行的控制量,它的准确获取才能使小车能够稳定地达到平衡,并且能够准确测量倾角,还能加大控制量。
方案一:倾角传感器,经测量倾角传感器灵敏度高,跷跷板两端采样值的差值20。
方案二:MMA7260三轴加速度计,该传感器可以测量重力延竖直方向上的分量,但是通过实际的检测发现其灵敏度低,且不稳定。
控制器的选择:对于一个不稳定系统,要控制系统达到平衡位置,需要加入一个控制器。
方案一:采用PID控制器。
PID控制器是一种适应范围广的控制算法。
可以达到一般的控制要求。
跷跷板的平衡是要达到两边的力矩平衡。
小车行驶到某一个特定的位置才能使跷跷板平衡。
方案二:采用步进法不断搜索平衡点,使系统达到平衡。
步进调节比较稳定。
由于倾角传感器的灵敏度的限制,控制量太小用PD控制器实现起来比较麻烦,而且参数的调节也不好控制,因此我们采用步进控制。
2.2控制算法设计采用步进控制,角度的变化量和长度的变化量均随时间而变,并且和各自速度相关,因此,引入小车每个控制周期的步进量 v ,和角度每个控制周期的变化量 ,假设速度控制的周期为T(ms),那么就有下面的式子合力钜: ()cos(T)f M G L v T M 合 (1)每个控制周期,先让小车走一段距离,停止一定时间测量角度,然后以这个角度为依据进行下一次平衡调节,如果所调的参数满足式子(1),那么跷跷板最终可以达到平衡。
电动车跷跷板设计跟总结报告摘要:本设计为使电动车在跷跷板上按要求准确运行采用了单片机A T89C51最小系统作为电动车的检测和控制系统。
通过红外发射接收一体探头检测路面黑色寻迹线,使小车按预定轨道行驶,根据角度传感器检测跷跷板的平衡状态控制电动车使其在跷跷板上达到动态平衡。
再加上基于STM8S单片机的键盘、液晶显示电路,构成了整个系统的硬件总电路。
最后通过软件设计,实现了按预定轨道行驶、保持平衡等功能。
关键字:STM8S 跷跷板角度(倾角)传感器1.方案设计与验证方案一:改装摇控电动车,利用单片机直接控制电动机,采用限位开关检测小车行驶位置。
由于小车是由单片机直接控制,所以驱动不了电机,实现不了小车的基本功能。
用限位开关不利于用小车的独立运行,且控制不便。
方案二:自制小车,利用步进电机,采用单片机控制,用电位器自制角度传感器,自制小车,制作过程极其复杂,且时间紧张,没有较好的机械部件支持,步进电机不易购买,体积较大,供电系统复杂,价格昂贵。
自制传感器精度不高,反应不灵活,线性度太差。
无法实现角度与电阻的线性转换。
方案三:自制小车,利用步进电机,采用stm8s单片机控制,使用现成的角度传感器跟现成的L298N电机驱动模块,成本低,花费时间短,精度高。
综上考虑,我们选择了方案三,经过一番仔细的论证比较,我们最终确定的系统详细方框图如下:2.电路设计2.1寻迹线探测模块通过光电检测器来实现黑白线的监测,当检测到黑线时输出端为低电平,白线时为高电平。
两个TCRT5000来实现小车走直线。
输出端要加上拉电阻,才能得到稳定信号,其原理图如图所示。
2.2电机驱动模块使用L298N,用单片机PWM能实现加速,减速,直线,转弯,后退等动作,原理图如下:3.3倾角检测模块MMA7361角度传感器采用了信号调理、单级低通滤波器和温度补偿技术,并且提供了2个灵敏度量程选择的接口和休眠模式接口,该产品带有低通滤波并已作零g补偿,原理图如下:4软件设计5测试方法跟结果仪器名称型号用途数量计算机联想调试程序 1数字万用表my-65 各种电路参数 1秒表测量时间 1测量结果次数到达A点时间到达B点时间到达C点时间总时间1 8.93 6.82 9.66 25.412 15.72 6.75 8.79 31.263 20.65 6.59 7.88 35.126设计总结经过我们小组的努力,我们终于成功的完成了题目的要求,并在此基础上进行了创新。
基于AT89S52单片机的电动车跷跷板系统设计作者:张建化陈跃熊永超来源:《现代电子技术》2008年第24期摘要:介绍电动车跷跷板系统的设计与实现。
该系统包括单片机系统电路、寻迹检测电路、平衡检测电路、步进电机驱动电路、数码显示电路等。
在系统中,以AT89S52单片机为电动小车控制核心,使用反射式红外发射接收器来检测轨迹,步进电机作为动力源实现小车前进后退和转向控制,用2个水银开关控制完成平衡状态的检测,用数码管分阶段实时显示电动车行驶所用时间。
3次实验数据表明,这里所提出的平衡检测方案是有效可行的。
关键词:寻迹检测电路;步进电机;跷跷板系统;平衡检测电路中图分类号:TP271.4文献标识码:B文章编号:1004-373X(2008)24-163-03Design of Seesaw System with Electric Vehicle Based on AT89S52 Single Chip ComputerZHANG Jianhua,CHEN Yue,XIONG Yongchao(Xuzhou Institute of Technology,Xuzhou,221008,China)Abstract:Design and implementation of seesaw system based on electric vehicle are introduced.The control system consists of AT89S52 single chip computer system,autonomous tracing circuit,balance detection circuit,driving circuit of stepping motor and LED display circuit.Centering on AT89S52,the track detection is realized by reflective infrared emitter and receiver and the steering of the vehicle is driven by stepping motor.The detection of balance state is implemented by two mercury switches and the travel time is displayed with LED separately.The scheme is proved to be effective and practical by experimental results during three tests.Keywords:autonomous tracing circuit;stepping motor;seesaw;balance detection circuit1 引言2007年全国大学生电子设计大赛的F题目是“电动车跷跷板”[1];题目要求设计并制作一个电动车跷跷板,使得电动小车从图1所示跷跷板起始端A出发在30 s内到达中心点C并保持平衡5 s,之后在30 s内到达跷跷板末端B并停留5 s,最后在1 min内退回到起始端A。
摘要:本系统采用AVR Mega系列单片机Mega16作为主控芯片,利用定时器中断产生序列脉冲控制步进电机动作和变频调速。
行程中使用红外对管探测引导线进行路线的准直调整及边缘检测。
使用倾角传感器完成倾角探测实现平衡的调节。
并利用STA013芯片对MP3进行解码,实现平衡状态的语音播报。
各动作过程中小车所用时间及与小车与水平面的夹角通过LCD即时显示。
关键词:Mega16 倾角传感器步进电机Abstract: This system adopts A VR micro processer Mega16 as main controller. The processer directs the motion of the motor by a sequence of pulses generated by the MCU timer interruption. In the purpose of adjusting its equilibrium,this system utilizes the inclination sensor to measure the angle of horizontal inclination In the process, and boundary detect is completed the collimation adjustment in the help of the light sensors. STA013 is put to use to decode the mp3,thus to report the equilibrium. The time spent in each process and the dip angle is displayed in the LCD.Keywords: Mega16 inclination sensor step-motor一、系统方案(一)实现方法:本系统的主要设计任务是完成一个精确定位运动的平衡小车系统。
电动车跷跷板报告电动车跷跷板报告【摘要】本系统采用遥控电动小汽车改装而成,主要由89C52和模拟电路为核心器件,实现对智能电动车行驶的自动控制。
整车长23 厘米,宽5厘米,运行性能良好,符合设计要求。
电动车平衡检测使用倾角传感器。
电动智能小车电路由平衡检测电路、计时显示电路、电机驱动电路等组成,它不需要遥控就能按要求行走。
一、方案的选择与论证根据题目要求,系统可以以划分为几个基本模块,如图1.1所示键盘检测平衡检测单片机电机驱动显示电路图1.1 1、步进电机驱动调速模块方案一采用与步进电机相匹配的成品驱动装置。
使用该方法实现步进电机驱动,其优点是工作可靠,节约制作和调试的时间,但成本很高。
方案二采用集成电机驱动芯片LA298。
采用该方法实现电路驱动,简化了电路,控制比较简单,性能稳定,但成本较高。
方案三采用互补硅功率达林顿管ULN2003实现步进电机的驱动。
采用该方法实现步进电机的驱动,电路连接比较简单,工作也相对可靠,成本低廉,技术成熟。
基于上述理论分析,最终选择方案三。
2、平衡检测模块方案一采用精密的倾角传感器,这种传感器对应每个角度输出一个固定电流。
可以实现精确控制,但价格昂贵。
方案二采用简易的倾角传感器,它直接输出一个开关量。
当其与地面垂直时,两触点断开;若倾斜角度超出一定范围,两触点短接。
这种传感器价格低廉,使用方便。
基于上述分析,最终选择方案二。
3、显示模块方案一采用数码管显示。
数码管具有经济、低功耗、耐老化和精度比较高等优点,但它与单片机连接时,需要外接存储器进行数据锁存。
此外,数码管只能显示少数几个字符。
方案二采用LCD进行显示。
LCD具有功耗低、无辐射、显示稳定、抗干扰能力强等特点,而且可以显示汉字。
考虑到本次设计的人性化设计,综合考虑,决定采用方案二。
4、电源选择考虑到本次设计对电源的要求,我们采用四节1.5V的干电池作为供电电源。
二、系统的具体设计与实现系统的组成及原理框图如图所2.1示。
摘要:本系统以凌阳16位单片机SPCE061A为控制核心,包括电机驱动模块,寻迹模块,角度测量模块,时间显示模块和无线通信模块五部分。
铝合金自制车体采用L298驱动直流减速电机实现行进,光电传感器结合寻迹算法完成电动车寻线功能。
利用角度传感器的测量量作为被控量,实现电动车的闭环反馈控制,根据模糊PID控制算法找到平衡点,这是本系统的核心部分。
同时PC显示模块和无线通信模块实现了良好的人机交互界面。
关键词:角度传感器;光电传感器;无线通信ABSTRCT:This intelligent electric car is based on 16 bits single chip –SPCE061A. The body is is capable of boarding the seesaw and finding the balance point using the angle sensor and returning,and show time. The system also provides communication channels between two single-chips by the wireless module and between single-chip and PC by UART, with dynamic interface on PC showing the state of car.Keywords: Angle sensor; Photo Sensor; Wireless transmission一、系统方案1.1、实现方法我们设计并制作了一个智能电动小车。
可以寻迹上翘翘板和沿板行使,并找到跷跷板的水平位置。
当跷跷板一端放有配重时,小车能自动行驶到与之相对的平衡位置,并随配重的移动中心调解重心。
1.2、方案论证为了较好实现在小车的功能,我们设计了几种方案并分别进行了论证。
基于单片机的电动车跷跷板的设计IntroductionThe electric scooter is a popular mode of transportation for those who are looking for a convenient and eco-friendly way to travel short distances. However, one issue with electric scooters is that they can be difficult to balance, particularly when traversing uneven terrain or obstacles such as speed bumps. This problem can be addressed by the addition of a teeter-totter, also known as a seesaw, to the design. In this paper, we present a design for an electric scooter with a teeter-totter that is controlled by a microcontroller, specifically the Arduino Uno.DesignThe electric scooter consists of a metal frame with a small, electric motor in the front wheel, a battery pack mounted beneath the platform that the rider stands on, and a teeter-totter mounted on the rear axle of the scooter. The teeter-totter is made from two metal beams, each with a curved end that can be clipped onto the rear axle of the scooter. The two beams are connected by a hinge, which allows them to pivot up and down as the rider leans forward and back to accelerate or brake.A microcontroller, in this case the Arduino Uno, is used to control the teeter-totter. The microcontroller reads data from an accelerometer that measures the angle of the scooter in relation to the ground. If the scooter tilts forward, indicating that the rider is accelerating, themicrocontroller sends a signal to a servo motor that lowersthe teeter-totter on the rear axle, adding additional stability and balance to the scooter. Similarly, when the rider brakes and tilts backward, the microcontroller raises the teeter-totter to maintain balance.ResultsThe electric scooter with the teeter-totter was successfully designed and constructed. The teeter-totter was found to significantly improve the stability and balance of the scooter, particularly when traversing uneven terrain or speed bumps. The microcontroller was able to accurately read data from the accelerometer and control the teeter-totter accordingly.ConclusionThe addition of a teeter-totter controlled by a microcontroller is a promising design for improving the stability and balance of electric scooters. Further testing and refinement may be necessary to optimize the design for different types of terrain and riding conditions.。
电动车跷跷板自动平衡控制系统设计1 方案设计按照任务书给定的功能要求,我们设计的电动车跷跷板自动平衡控制系统结构框图如图1-1所示,被控对象由电动小车与跷跷板组成。
通过安装在小车上的角度传感器测量小车平衡位置,平衡状态下传感器输出角度值作为系统给定值,实时状态下的传感器输出作为系统输出值。
1. 1 控制原理在电动车运行中,实时采集输出值,与给定值比较,不平衡时,根据偏差通过控制算法计算出输出,作用于电动车驱动电路,使车前后运动,最终达到平衡。
电动车在行走与寻找平衡的过程中,需要自动寻迹,这个过程也是一个反馈控制过程,其结构图如图1-2所示。
该系统的输入即给定轨迹是电动车正常行驶对应的位置信号,系统的输出即实际轨迹是实时测量获得的电动车位置信号。
本设计采用五组光电对管,产生五个位置信号分别用于前进与后退时轨迹的测量,同时也用于车位测量。
根据信号的组合判断电动车运行状态及应该调整的方向,控制电动车转向从而自动寻迹,或者根据车位控制电动车行走与停车。
根据上述思想,设计了自动控制系统的具体电路,系统结构图如图1-3所示。
2 系统硬件设计与实现2.1 单片机及其扩展电路按照性能价格比高的原则,选择8位单片机PIC16F877A 作为系统的控制核心,在此基础上根据系统要求设计了单片机扩展电路。
主要包括时间显示、平衡状态指示及其输入输出接口。
PIC 系列单片机指令系统精练,它可以实现在线调试和在线编程。
PIC 单片机内集成了上电复位电路、I/O 引脚上拉电路、看门狗定时器等,对于本设计来讲,利用其片内集成的10位A/D 电路,可以最大程度地减少外接器件。
2.2 电机驱动模块的电路设 计与实现本系统电动车驱动使用直流电动机,采用H 型驱动电路,电压控制采用PWM 方式以方便调速。
这种电路由于工作在管子的饱和或截止状态下,效率非常高,有利于节省能源。
该电路电子开关的速度很快,稳定性也很强,可以简单的实现转向控制。
第七届(2005年)全国大学生电子设计竞赛题目(部分)电动车跷跷板(F题)【本科组】一、任务设计并制作一个电动车跷跷板,在跷跷板起始端A一侧装有可移动的配重。
配重的位置可以在从始端开始的200mm~600mm范围内调整,调整步长不大于50mm;配重可拆卸。
电动车从起始端A出发,可以自动在跷跷板上行驶。
电动车跷跷板起始状态和平衡状态示意图分别如图1和图2所示。
二、要求1.基本要求在不加配重的情况下,电动车完成以下运动:(1)电动车从起始端A出发,在30秒钟内行驶到中心点C附近;(2)60秒钟之内,电动车在中心点C附近使跷跷板处于平衡状态,保持平衡5秒钟,并给出明显的平衡指示;(3)电动车从(2)中的平衡点出发,30秒钟内行驶到跷跷板末端B处(车头距跷跷板末端B不大于50mm);(4)电动车在B点停止5秒后,1分钟内倒退回起始端A,完成整个行程;(5)在整个行驶过程中,电动车始终在跷跷板上,并分阶段实时显示电动车行驶所用的时间。
2.发挥部分将配重固定在可调整范围内任一指定位置,电动车完成以下运动:(1)将电动车放置在地面距离跷跷板起始端A点300mm以外、90°扇形区域内某一指定位置(车头朝向跷跷板),电动车能够自动驶上跷跷板,如图3所示:(2)电动车在跷跷板上取得平衡,给出明显的平衡指示,保持平衡5秒钟以上;(3)将另一块质量为电动车质量10%~20%的块状配重放置在A至C间指定的位置,电动车能够重新取得平衡,给出明显的平衡指示,保持平衡5秒钟以上;(4)电动车在3分钟之内完成(1)~(3)全过程。
(5)其他。
三、说明(1)跷跷板长1600mm、宽300mm,为便于携带也可将跷跷板制成折叠形式。
(2)跷跷板中心固定在直径不大于50mm的半圆轴上,轴两端支撑在支架上,并保证与支架圆滑接触,能灵活转动。
(3)测试中,使用参赛队自制的跷跷板装置。
(4)允许在跷跷板和地面上采取引导措施,但不得影响跷跷板面和地面平整。
摘要本方案以STM32F103RB单片机、直流电机驱动电路、MPU-6050、反射式红外传感器、稳压模块等电路构成。
小车采用前方的左中右三个反射式红外传感器,能沿着黑线在跷跷板上往返行驶,并始终保持在跷跷板上;同时,利用MPU-6050对小车当前所在位置的倾斜角进行测量。
小车控制程序主要对采集信号分析转换,结合PWM调速控制电机转速和转向,从而使小车快速在跷跷板上取得平衡;小车通过蜂鸣器来实现平衡指示以及实时显示,从而完成整个设计过程。
实验结果验证了该系统的性能满足设计要求。
关键词:STM32F103RB MPU-6050反射式红外传感器 PWM调速AbstractThe programs to STM32F103RB microcontroller, DC motor drive circuit, MPU-6050, reflective infrared sensor, voltage regulator modules and other circuits. Car used left, right in front of three reflective infrared sensor that can travel back and forth along the black line on a seesaw, and keep the seesaw; Meanwhile, MPU-6050 tilt angle of the trolley current location is measured. Car control program focuses on the acquisition signal analysis conversion, combined with PWM speed control motor speed and direction, allowing the car to quickly strike a balance on a seesaw; trolley buzzer to achieve balance through instructions and real-time display, thus completing the entire design process. Experimental results demonstrate the performance to meet the design requirements of the system.Key word: STM32F103RB MPU-6050 PWM SpeedReflective infrared sensor目录1系统方案 (1)1.1 姿态检测模块的论证与选择 (1)1.2 电机驱动模块的论证与选择 (1)1.3 稳压模块的论证与选择 (1)1.4 测量模块的论证与选择 (2)2系统理论分析与计算 (3)2.1 PID控制器设计 (3)2.2 基于卡尔曼滤波的数据融合 (3)3电路与程序设计 (4)3.1电路的设计 (4)3.1.1电路系统总体框图 (4)3.1.2 电源系统电路 (4)3.1.3 电机驱动模块电路原理图 (4)3.2程序的设计 (5)3.2.1程序流程图 (5)4测试方案与测试结果 (8)4.1测试方案 (8)4.2 测试条件与仪器 (8)4.3 测试结果及分析 (8)4.3.1测试结果(数据) (8)4.3.2测试分析与结论 (9)5总结 (9)附录 (10)1.电路原理图 (10)2.元器件清单 (12)3.主要源程序 (13)1系统方案本系统主要由姿态检测模块、电机驱动模块、测量模块、稳压模块、电源模块组成。
电动车跷跷板制作与设计摘要:本电动车跷跷板是以吕合金为车架,msp430单片机为控制核心,加以步进电机、红外光电传感器、光耦传感器、倾角传感器、LCD数码光和电源电路以及其他电路构成。
系统由msp430通过IO口控制小车的前进后退停止平衡以及转向。
寻迹由ST188型红外光电对管完成,平衡由倾角传感器完成,用L298N 驱动步进电机,同时本系统用LCD数码管进行数字显示,以显示当前电动车的运动状态。
关键词:msp430 步进电机 L298N 红外光电传感器倾角传感器 LED数码管一.模块方案比较与设计根据题目要求,本系统主要由控制器模块、电源模块、寻迹传感器模块、平衡传感器模块、步进电机及其驱动模块、LCD数码管模块。
本系统的方框图如下图所示:为较好的实现各模块的功能,我们分别设计了几种方案并分别进行了论证。
1.1.1车架设计方案1:购买玩具电动车。
购买的玩具电动车具有组装完整的车架车轮、电机及其驱动电路。
但是一般的说来,玩具电动车具有如下缺点:首先,这种玩具电动车由于装配紧凑,使得各种所需传感器的安装十分不方便。
其次,玩具电动车的电机多为玩具直流电机,力矩小,空载转速快,负载性能差,不易调速。
而且这种电动车一般都价格不扉。
因此我们放弃了此方案。
方案2:自己制作电动车。
经过反复考虑论证,我们制定了三轮电动车,后面两轮分别驱动转向。
前面按一个万向轮。
即左右轮分别用两个转速和力矩基本完全相同的步进电机进行驱动,前面装一个万向轮。
这样,当两个步进电机转向相同但转速不同时就可以实现电动车的转弯,由此可以轻松的实现小车的左转和右转。
对于车架材料的选择,我们经过比较选择了铝合金。
用铝合金做的车架比塑料车架更加牢固,比铁制小车更轻便,美观。
综上所述,最后选择方案二。
1.1.2控制器模块本次比赛是由TI公司赞助,因此我们直接选用该公司开发的msp430 16位单片机,它是16位控制器,具有体积小、驱动能力高、集成度高、易扩展、可靠性高、功耗低、结构简单、处理速度高、中断处理能力强等特点。
大学生电子设计竞赛电动车跷跷板参赛学生:学校:赛前指导老师:2012年9月电动车跷跷板摘要本设计采用两个凌阳SPCE061A 16位单片机作为控制核心。
其中一个安装在小车上,另一个持在使用者手中连接键盘和LCD,通过无线模块进行双机通讯,实现远程对小车运行状态的实时监测。
为了对小车的行为进行精确控制,采用步进电机进行驱动。
系统通过倾角传感器采集跷跷板的倾角变化后传给单片机。
程序控制方法采用PID算法,使小车通过一个二阶欠阻尼脉冲响应过程最后趋于动态平衡。
根据设计需要,车体采用有机玻璃与铝合金自制而成。
关键词:SPCE061A单片机,角度传感器,光电传感器,PID算法.Abstract:This system takes two SPCE061A 16 bit microprocessor as the control center, one fixed on the car and another connected with keyboard and LCD handed by the controller. In this system, wireless is used to complete the two processors` communication to acquire a perfect interface between the controller and the whole control system. The car with four wheels is driven by two stepper motors, and through the angle sensitive gathering the information about the teeterboard’s equinity condition and then send to the microprocessor. The system takes the PID as main control method, through a progress of two pulse damping response, the car and the teeterboard finally reach an equinity condition.Keywords: SPCE061A microprocessor, angle sensor, light sensor, PID.1.系统方案设计1.1实现方法采用倾角传感器检测跷跷板与水平面的夹角,通过PID算法控制小车寻找平衡位置。
当跷跷板在允许范围内满足达到平衡状态时,暂停5秒后行驶到跷跷板B端;当小车的上的四个光电开关同时检测到预先粘贴在跷跷板B端上的黑线时记数1,并倒车回到跷跷板A端,当四个光电开关第二次同时检测另一端的黑线时记数2,小车停止,此时基本部分完成。
在发挥部分中,我们采用黑线引导小车走上跷跷板,小车启动时在水平位置,以此为标志来选择调用发挥部分所需要的程序,使小车在找到平衡之后停在原位并在收到扰动之后自动寻找新的平衡。
在完成题目要求的同时,我们也做出了自己的特色。
我们利用一个从单片机制作了一个手持观测系统,进行小车状态的实时播报和显示,另外还制作了电池低电压报警电路。
1.2方案比较与论证1.2.1控制器模块由于题目要求的小车功能较多,如果采用一个单片机会使各模块之间的程序嵌套复杂,而且难以实现总体系统的稳定性要求。
此外该控制系统程序庞大,包括角度传感器、光电传感器,LCD,语音模块,时钟等模块,一个单片机难以存储。
所以我们采用两个SPCE061A 16位单片机,一个为主控制器安装在小车上来控制小车的行驶,另一个为从单片机持在控制者手中,用来连接LCD,键盘以及语音模块。
主从单片机之间采用无线通讯,实现两机之间的信息交流。
这样不仅可以很好的解决上述问题,而且使人机交互界面变得更加方便完美,也更加人性化和智能化。
1.2.2电机驱动模块方案一:采用H桥式电路驱动的直流电机作为小车驱动。
直流减速电机输出力矩大,功耗相对较低,且运行平稳,但本题目需要对小车的位置进行精确步进控制,而直流电机输出轴之间存在一定间隙,而且不能精确定位控制,所以我们放弃此方案。
方案二:采用输出力矩相对较大的步进电机,这样能够保证两个轮子的速度基本相同,实现了小车的精确控制。
为了使步进电机低速时转动更平滑,采用专门的电机细分驱动芯片TA8435驱动电机,利用两个定时器控制电机速度,实现小车的速度与方向调整。
实践证明该方案电路简单、控制方便且工作稳定。
电路见附图一。
所以我们选择方案二。
1.2.3角度测量模块采用市场购买的低成本双轴倾角传感器ZCT245AL-485。
ZCT245AL-485输出采用半双工通信方式RS485与单片机UART互通信息。
它具有零角度设定,波特率可选等功能。
ZCT245AL-485的精度高达0.1度,侧角范围正负45度,每秒送给单片机15次倾角值。
完全可以满足本题目要求。
测量方向见图1。
程序见附录图1倾角传感器测量方向1.2.4 行进路线准直方案论证与选择在跷跷板上贴宽度为2cm的黑线,采用发射接收一体化的单光束反射取样式光电传感器RPR220作为敏感元件,利用红外线对不同颜色的反射系数不同而产生强弱电流信号,该方案受外界环境的影响比较小,抗干扰性比较强。
如寻迹原理图所示,当1,2检测到黑线,3,4白色时,小车会通过差速左转直至1,2检测通时到黑线为止。
电路图见附图2。
程序见附录1.2.5显示及语音模块由于本设计采用的是凌阳SPCE061A单片机,其芯片内部具有专门的语音功能。
本控制系统对于语音没有很高的要求,而且从单片机所承担的任务较少完全能够利用SPCE061A单片机自身资源实现语音功能。
时间,角度以及路程的实时显示采用LCD模块OCMJ128x64,自带字库,编程简单,而且功能齐全。
1.2.6电源模块为了减轻小车重量,方便小车自由行驶,我们采用可充电的大容量锂电池作为小车电源,输出电压12V。
中间加装一个开关电源稳压至5伏,给单片机等控制电路供电,电源效率高,比7805等三端稳压器节省能源。
1.3系统设计1.3.1 系统总体方案经过上述的分析和论证,决定了系统各模块采用的最终方案如下:车体:由有机玻璃和铝合金片加工而成;主控单元:两个凌阳16位单片机SPCE061A;循迹模块:接收一体化红外传感器RPR220;倾角检测模块:数字式双轴倾角传感器(ZCT245AL-485)驱动模块:两相混合式步进电机42BYG021+TA8435细分驱动芯片语音播报模块:单片机自带D/A+基于SPY0030的功率放大电路+扬声器计时模块:DS1302和凌阳单片机内部时钟显示模块:OCMJ128x64 LCD单片机无线通讯:半双工无线通讯模块nRF24011.4结构框图(见图3)图3系统结构框图2.理论分析与计算2.1测量与控制方法 1). 小车平衡的PID 算法经过分析可得小车在翘翘板上寻找平衡点的是一个二阶欠阻尼震荡过程如图4:图4 二阶欠阻尼震荡 算法公式:tt k dtt k t k t V t σσθθθθ)()(1])([)(30201+++=⎰,其中])([01θθ+t k 是比例环节 ,⎰+dtt k t ])([1002θθ是积分环节,tt k σσθ)(3是微分环节。
比例环节:及时成比例地反映控制系统的角度偏差信号])([01θθ+t k ,偏差一旦产生,通过角度传感器传给单片机,单片机立即产生调整控制信号,])([01θθ+t k 。
其中常数0θ使用来控制翘翘板达到平衡位置时与水平面的夹角。
在题目要求中0θ=0即跷跷板要在水平位置平衡。
积分环节:主要用于消除跷跷板趋于平衡时的稳态误差,提高系统的无差度。
可是积分环节动态反映时间较长,这样虽然是系统更加稳定,但是却延长了系统的动态相应时间,而且算法复杂,考虑到该题目中的平衡的控制并不是很复杂,而且有允许在要求范围内存在些许误差,所以我们放弃积分环节。
微分环节:微分环节能反映角度偏差信号的变化趋势(变化速率),并能在角度偏差信号值变得太大之前,在系统中引入一个有效的早期修正信号,从而加快系统的动作速度,减小调节时间。
在该微分控制中,控制器系统的输出速度)(t V 与输入误差信号的微分(即角速度)tt σσθ)(成正比关系。
微分环节使抑制误差的作用变化“超前”,即在误差接近0时,抑制误差的作用就应该是0。
综合考虑我们决定采用PD 算法来实现整个系统的平衡控制。
公式为:tt k t k t V σσθθ)()()(31+=。
2.2 理论计算确定参数小车启动时,)(t θ=5度,tt σσθ)(=0度/秒,所以)()(1t k t V θ=。
小车由点A 到点C 大约需要10~20秒的时间,/AC/=80cm 。
t /AC/)()(1==t k t V θ,推出度秒)(5*20~1080(t)t /AC/1cm k ==θ。
可得出1k 的取值范围在(0.8,1.6)区间之内。
根据多次测试结果参数3k 在区间(1,1.3)范围内时小车寻找的平衡的效果最好。
2.3误差分析由于系统存在很多外在因素引起的误差,比如步进电机低速转动时的震动使角度传感器的制在一定范围内波动,因而对小车寻找平衡产生很大的干扰;即使小车处于平衡点时,跷跷板仍然存在微小的扰动,这些扰动会使小车不停的移动,从而大大延迟了小车调节平衡的时间,消除这些影响,我们设定当-2度<)(t θ<2度时,比例环节作用关闭,当-1.4度<tt σσθ)(<1.4度时积分环节关闭,由此来消除外界环境因素及小车子身设计所带来的误差影响。
3.电路与程序设计3.1检测与驱动电路电机驱动电路:电路见附图一:细分电机驱动芯片TA8435电路图 直线寻迹模块:电路见附图二:光电对管寻迹电路图3.2总体电路图见附图三:系统总线图3.3软件设计与工作流程图该小车控制系统根据题目要求主要包括角度检测程序,时间显示,语音播报和寻迹程序等,以及我们在创新发挥部分自加的无线通讯模块。
为了节省篇幅,在这我们只附上我们的程序流程图,(即图五)。
图5程序流程图程序代码见附录:部分程序代码4.结果分析4.1创新发挥我们采用自制车体,题目要求实时显示小车各阶段所用的时间等信息,若将LCD安装在不断运动的小车上,观察极为不便,为此我们为了方便控制者实时观察小车的行驶状态,我们用一个从单片机制作了一个手持人机交换系统,与主单片机之间采用nRF2401相互交换信息。
4.2结果分析1).测试仪器:PC机、秒表、卷尺;SPCE061单片机系统2).将系统的电机模块、直线行进模块、角度测量模块、液晶显示模块和语音模块分开测试,通调后在进行整机调试,以提高测试效率。