基于自由摆的平板控制系统
- 格式:doc
- 大小:176.43 KB
- 文档页数:17
B组基于自由摆的平板控制系统参赛学校:参赛学生:指导老师:联系方式:基于自由摆的平板控制系统摘要本控制系统由核心控制模块、角度采样模块、电机驱动模块、液晶显示模块、键盘控制模块等部分组成。
经实验证明本控制系统设计的各项指标都满足大赛的基本部分和核心部分的要求,部分设计实现大赛发挥部分,符合大赛目的。
关键字:STC12C5A60S单片机、角度传感器、L297、L298控制芯片、步进电机。
Abstract一、总体方案比较与论证方案一、方案二、利用STC12C5A60S2单片机作为控制系统,由单片机内部的AD转换模块对角度角度传感器 摆杆θ θ摆杆 平板平板二、各模块设计介绍1、角度采集模块设计根据题目要求,要保持平板平衡,需利用角度传感器随时测量旋转角度,角度传感器和单片机的连接2、键盘控制模块3、核心控制模块本设计的核心控制模块主要是由STC12C5A60S2单片机组成。
图14、液晶显示模块5、电机驱动模块12U1A74LS0734U1B 74LS071110U1E74LS071312U1F74LS07RED1ORANGE2Y E L L O W3PINK4B L U E5STEP MOTOR4 PHASE+12VORANGE PINKYELLOWBLUEREDABCD三、测试方案与测试结果在完成后进行调试时,采用的方法是首先分别调试各单元模块,调通后在进行整机调试的方法。
1、摆杆转动角度的测试。
2、键盘控制模块的调试。
3、液晶显示模块的调试。
4、单片机程序的调试。
5、步进电机转动角度的调试。
6、对设计的整体测试。
四、结论我们的设计利用单片机STC12C5A60S2作为核心控制,通过采集角度传感器的实时电压,利角度传感器采集来的数据和步进电机的状态实时显示在液晶屏上面,以便我们能够对系统的整体运行状态进行监控。
五、参考文献:。
基于自由摆平板的控制系统浙江万里学院罗志强周伟凯张政指导老师胡江王阳摘要本系统基于Altera的MAXII FPGA和新华龙C8051F单片机,采用MMA7455加速度传感器进行摆杆释放感应,由MXD2020EL角度传感器进行数据采集,通过FPGA进行角度值测量,交由MCU进行数据的处理,产生一系列脉冲信号经L298N 驱动使步进电机工作。
通过按键选择完成不同的功能,完成自由摆平板的控制系统。
由于FPGA的测量频率高,并且使用两个传感器的加强了角度测量与定位的准确度,从而测得的角度值精确,操控性能优良,因此系统能够出色完成设计目标。
关键词:角度传感器;FPGA;单片机;电机1.系统方案选择自由摆控制系统主要由:主控模块、角度传感器模块、电源驱动模块、机械结构组成。
方案一:基于单片机为核心的控制系统,利用AD603芯片对电位器角度传感器(模拟型)进行电压采样,再经模数转换,将模拟的角度变为数字信号,通过单片机处理计算输出脉冲驱动步进电机。
方案二:使用基于Altera MAXII系列FPGA和新华龙的C8051主控芯片FPGA 在数据采样方面的优势是单片机无法比拟的,而单片机的数据处理能力FPGA同样无法取代。
两者结合,优势互补。
角度测量采用MXD2020EL,此芯片精确度高,操作简单。
利用MMA7455加速度传感器进行摆杆释放感应,MMA7455是一款数字输出、低功耗、紧凑型电容式微机械加速度计,具有信号调理、低通滤波、温度补偿、自测、可配置,通过中断引脚检测0g、以及脉冲等功能。
通过FPGA对MXD2020EL角度传感器产生的方波进行采样,转换成数字信号传给MCU。
MMA7455加速度传感器测量失重信号,通过SPI通信直接传给单片机进行数据处理。
通过一系列判断得出摆杆的状态控制步进电机的转动。
出于对可操作性,准确性和测试精度的考虑,我们选择了方案二。
2.理论分析和系统框架本设计通过MXD2020EL角度传感器捕获摆杆角度的变换,而模组可以使用单轴可以测量2个面的倾角±60°及使用双轴测量1个面内的0~360°的倾角,我们这里使用双轴测量一个面内的角。
基于自由摆的平板控制系统本系统以单片机为控制核心,采用增量旋转编码器实时采集自由摆旋转角度及方向,通过步进电机开环控制平板旋转角度,以实现控制要求。
此外,为方便实验和调试,专门设计了独立的单片机角度显示电路。
本设计以旋转编码器的脉冲触发单片机的中断来控制平板角度的调整,这种外部事件驱动的程序设计方法能够及时响应摆杆角度的变化,避免了复杂的定时采样程序设计,总体程序设计简洁,响应时间快,控制精度高。
在激光笔瞄准时采用了查表法,避免了单片机进行复杂三角函数运算造成的舍入误差对实验精度的影响,从而达到了在一个周期里电机精确旋转一周;平板角度调整速度快,8枚硬币滑动小无跌落;实时控制激光笔保持静态水平误差在1cm以内;动态控制误差在2cm以内的实验效果。
关键词:旋转编码器、定时采样、角度采样、精确控制。
一、引言系统设计任务为一种基于自由摆的保持平板平衡的控制系统。
基本要求是保持平板上硬币的平衡滑动小或滑落少,进一步的要求是让平板上激光笔射在靶纸上的光斑偏移量尽可能小。
在实时控制时,对自由摆的摆角、摆速及摆动方向的测量十分关键,平板角度的控制精度和相应速度也直接决定着最终的控制效果,如图1。
图1 单板结构示意图二、系统方案设计1、总体方案选择根据题目要求,摆杆在摆动时,方向不同,要求单片机做出方向判断从而及时调整电机保证平板平衡。
方案一:本方案就是在固定轴上装有微动开关,利用摆杆摆动时的力拨动开关以解决该问题。
优点是:机械装置,无需软件方面的设计,一旦触发可靠性高。
缺点:本身灵敏度不高,在测试中常出现摆动力度太小无法开启开关的现象,影响程序的执行。
方案二:电位器滑动时电压随即变化,可以将角度的变化转化为电压的数值,且两者是一一对应的,这里的电位器起到了角度传感的作用。
优点是:价格优廉。
缺点:精度不够。
方案三:采用增量旋转编码器实时采集自由摆旋转角度及方向,由单片机控制步进电机,使平板实时动态平衡。
优点:精度教高,便于控制。
基于自由摆的平板控制系统(B题)摘要本系统采用STC12C5A60S2单片机作为核心处理芯片,用STC12C5A60S2对电机进行对平板正转,反转的控制。
平板旋转的角度由角度传感器ADXL345完成。
角度量通过IIC总线接口获得,然后再通过分析和判断,再对电机进行控制转动,使的平板保持平衡,从而使硬币不掉落平板。
此外,还用到显示频NOKIA5510显示倾斜角度,和语音模块ISD1420。
AbstractThe system uses stc12c5a60s2monolithic integrated circuits,with a central treatment of electrical stc12c5a60s2the flat is to reverse the control of a flat spin. the angle from the angle sensor adxl345.the angle of the interface by IIC,and then by analysis and assessment,the motor control of a flat,to balance a coin fall,thereby, not flat.in addition,it is also used to show businesses,and shows lean nokia5510 voice module isd1420.关键词:单片机摆动平板角度传感器目录摘要 (1)第一章系统设计及方案论证与比较 (3)1.1系统总体方案设计 (3)1.2方案的设计与论证 (3)1.2.1控制模块的选择 (3)1.2.2电机的选择 (3)1.2.3电机驱动的选择 (3)第二章理论分析及计算 (4)2.1平板状态测量方法 (4)2.2建模与控制方法 (5)第三章电路与程序设计 (5)3.1硬件电路设计 (5)3.1.1主控电路设计 (5)3.1.2步进电机驱动电路设计 (6)3.1.3角度传感器电路设计 (6)3.2软件程序设计流程 (7)第四章测试结果及分析 (7)4.1测试步骤 (8)4.2测试结果 (8)4.3结果分析 (8)结束语 (9)附件一完整的电路原理图 (10)附件二测试结果 (12)附录三重要的源程序 (13)第一章系统设计及方案论证与比较1.1系统总体方案设计根据题目给定的条件,我们设计的方案总体上由单片机系统模块,电机控制模块,语音模块和传感器模块四部分组成。
基于自由摆的平板控制系统————————————————————————————————作者:————————————————————————————————日期:基于自由摆的平板控制系统(B题)摘要本系统采用STC12C5A60S2单片机作为核心处理芯片,用STC12C5A60S2对电机进行对平板正转,反转的控制。
平板旋转的角度由角度传感器ADXL345完成。
角度量通过IIC总线接口获得,然后再通过分析和判断,再对电机进行控制转动,使的平板保持平衡,从而使硬币不掉落平板。
此外,还用到显示频NOKIA5510显示倾斜角度,和语音模块ISD1420。
AbstractThe system uses stc12c5a60s2 monolithic integrated circuits, with a central treatment of electrical stc12c5a60s2 the flat is to reverse the control of a flat spin. the angle from the angle sensor adxl345. the angle of the interface by IIC, and then by analysis and assessment, the motor control of a flat, to balance a coin fall, thereby, not flat. in addition, it is also used to show businesses, and shows lean nokia5510 voice module isd1420.关键词:单片机摆动平板角度传感器目录摘要 (3)第一章系统设计及方案论证与比较 (5)1.1系统总体方案设计 (5)1.2方案的设计与论证 (5)1.2.1控制模块的选择 (5)1.2.2电机的选择 (5)1.2.3电机驱动的选择 (5)第二章理论分析及计算 (6)2.1平板状态测量方法 (6)2.2建模与控制方法 (7)第三章电路与程序设计 (7)3.1硬件电路设计 (7)3.1.1主控电路设计 (7)3.1.2步进电机驱动电路设计 (8)3.1.3角度传感器电路设计 (8)3.2软件程序设计流程 (9)第四章测试结果及分析 (9)4.1测试步骤 (10)4.2测试结果 (10)4.3结果分析 (10)结束语 (11)附件一完整的电路原理图 (12)附件二测试结果 (14)附录三重要的源程序 (15)第一章系统设计及方案论证与比较1.1系统总体方案设计根据题目给定的条件,我们设计的方案总体上由单片机系统模块,电机控制模块,语音模块和传感器模块四部分组成。
A 题基于自由摆的平板控制系统一、任务设计并制作一个自由摆上的平板控制系统,其结构如图1 所示。
摆杆的一端通过转轴固定在一支架上,另一端固定安装一台电机,平板固定在电机转轴上;当摆杆如图2 摆动时,驱动电机可以控制平板转动。
二、要求1.基本要求(1)控制电机使平板可以随着摆杆的摆动而旋转(3~5 周),摆杆摆一个周期,平板旋转一周(360º),偏差绝对值不大于45°。
(2)在平板上粘贴一张画有一组间距为1cm 平行线的打印纸。
用手推动摆杆至一个角度θ(θ在30º~45º间),调整平板角度,在平板中心稳定放置一枚1 元硬币(人民币);启动后放开摆杆让其自由摆动。
在摆杆摆动过程中,要求控制平板状态,使硬币在 5 个摆动周期中不从平板上滑落,并尽量少滑离平板的中心位置。
(3 )用手推动摆杆至一个角度θ(θ在45 º~60º间),调整平板角度,在平板中心稳定叠放8 枚1 元硬币,见图2;启动后放开摆杆让其自由摆动。
在摆杆摆动过程中,要求控制平板状态使硬币在摆杆的 5 个摆动周期中不从平板上滑落,并保持叠放状态。
根据平板上非保持叠放状态及滑落的硬币数计算成绩。
2.发挥部分(1)如图3 所示,在平板上固定一激光笔,光斑照射在距摆杆150cm 距离处垂直放置的靶子上。
摆杆垂直静止且平板处于水平时,调节靶子高度,使光斑照射在靶纸的某一条线上,标识此线为中心线。
用手推动摆杆至一个角度θ(θ在30º~60º间),启动后,系统应在15秒钟内控制平板尽量使激光笔照射在中心线上(偏差绝对值<1cm ),完成时以LED 指示。
根据光斑偏离中心线的距离计算成绩,超时则视为失败。
(2 )在上述过程完成后,调整平板,使激光笔照射到中心线上(可人工协助)。
启动后放开让摆杆自由摆动;摆动过程中尽量使激光笔光斑始终瞄准照射在靶纸的中心线上,根据光斑偏离中心线的距离计算成绩。
基于自由摆的平板控制系统一、总体方案设计1.主控系统选择方案一:使用传统51单片机作为主控制器,价格低廉,但其运算速度慢,片内资源少,存储容量小,难以实现复杂的算法。
方案二:使用FPGA,CPLD等大规模可编程逻辑控制器件,其时钟频率很高,运算速度很快,但不适合于该题目。
方案三:使用基于ARM Cortex-M3内核的EasyARM1138单片机,它有8通道10位ADC,使用方便且低功耗。
方案比较:综合比较,选择方案三。
2.角度测量方案一:使用双轴倾角传感器SCA103T-D04,测量范围为±15度,可适用于垂直方向的各种角度的测量。
方案二:使用电位器作为角度传感器,由于不同角度输出的电阻值不同,通过AD采样电阻两端电压,计算得到角度。
方案三:使用Angtron-RE-38-V-Lite旋转编码器,角度测量范围为0~360°,根据不同角度,可直接输出不同的电压值,线性度好。
方案比较:对于方案一,虽然SCA103T精度较高,但它是基于加速度原理进行测量,使用SCA103T进行倾角检测时,应保证被测设备匀速运动,否则会引进误差,而在自由摆系统中,平板不是匀速运动。
虽然可以采用峰值滤波和一阶惯性滤波相结合的方式通过软件编程进行处理,但较繁琐。
对于方案二,对于一般的电位器,线性度较差,而对于线性度较好的电位器,如22HP-10等,价格较高。
对于方案三,使用该旋转编码器,可以直接对输出电压进行AD采样,计算得出角度值,使用方便。
综合考虑,选择方案三测量自由摆运动过程中的摆角。
3.电机选择方案一:使用伺服电机作为执行元件,运行精确,能高速制动,惯量小,适合闭环控制。
方案二:使用步进电机作为执行元件,由于步进电机是采用脉冲驱动,精度较高,适合开环控制。
方案比较:对于方案一,虽然伺服电机性能良好,但价格较高。
对于方案二,步进电机可以通过16细分可以减弱低频振动,控制方便,开环性能良好,可以适用于该设计。
基于自由摆的平板控制系统最终年全国大学生电子设计竞赛HEN system office room 【HEN16H-HENS2AHENS8Q8-HENH1688】2011年全国大学生电子设计竞赛基于自由摆的平板控制系统(B题)【本科组】2011年9月3日摘要采用ATmage16 avr单片机作为主控芯片的基于自由摆的平板控制系统。
利用高精度的电位器和单片机的片内模数转换器测量自由摆的摆动角度。
ULN2003N达林顿阵列驱动,1/16倍速的减速步进电机控制平板的转动。
能够实现根据摆杆角度平板转动相应角度、摆杆摆动一周期平板转动一圈、控制平板使得摆杆摆动时平板上的硬币不滑落、平板上的激光笔在摆杆摆动一定角度后照射到靶子中心线等要求。
关键词:自由摆 AVR单片机电位器减速步进电机目录基于自由摆的平板控制系统(B题)【本科组】1系统方案本系统主要由中央处理器模块、电机驱动模块、摆杆角度测量模块、电源模块组成,下面分别论证这几个模块的选择。
中央处理器的论证与选择方案一:目前应用很广泛的51系列单片机。
该系列的单片机具有价格低廉、性能稳定、技术成熟等特点。
但缺点也很明显,运行速度不是很快,而此次设计应需要较为复杂的运算,所以可能达不到要求。
方案二:AVR系列的单片机。
该系列单片机较于早期的51单片机,片内资源更丰富,接口也更强大,同时采用的是RISC精简指令集,在运行速度上较与51有绝对的优势。
而价格低廉的优势也同样存在。
方案三:ARM处理器。
ARM处理器主要应用于嵌入式系统的开发,支持Thumb(16位)/ARM(32位)双指令集,兼容性好,大量使用寄存器执行速度快。
单从性能上讲,AMR绝对强与AVR与51,但其价格昂贵,并不是很适合本次设计。
因此次设计需要设计加速度传感器对于角度的计算,需要较大的计算量,且系统对于精度的要求较高,故选择方案二。
电机驱动模块的论证与选择方案一:L298H桥式驱动芯片。
该芯片具有性能稳定、控制灵活、输出电流大等特点,可以很方便控制直流电机的转动方向。
2011年全国大学生电子设计竞赛设计论文基于自由摆的平板控制系统(B题)2011年9月3日摘要本系统以C8051F410作为自由摆系统的主控制芯片,利用旋转式精密电位器电压的变化来测量摆杆角度,通过对步进电机的调节,实现了平板周期性的自由旋转,硬币的平衡控制,以及激光笔对靶心的直射。
系统的摆杆角度量范围为±90度,分辨率为0.1度,测量与控制的速度能够满足实时要求,是理想的控制方案。
关键词:C8051F410,倾角测量,步进电机,单摆目录1 方案论证与比较 (1)1.1处理器的比较与选择 (1)1.2摆角测量方法比较与选择 (1)1.3平板控制方法比较与选择 (1)2 系统设计 (2)2.1总体设计 (2)2.2机械结构设计 (2)2.2.1 支架设计 (2)2.2.2 摆杆设计 (2)2.3系统硬件单元设计 (3)2.3.1 单片机最小控制单元 (3)2.3.2 摆杆位置的测量 (3)2.3.3 平板状态控制单元 (4)2.3.4 人机接口单元 (5)3 软件设计 (5)3.1系统初始化 (5)3.2步进电机的控制算法 (6)3.3步进电机调整值的计算 (7)4 系统测试 (8)4.1测试数据 (8)4.2误差分析 (8)5 结论 (9)参考文献 (9)附录 (10)附1系统电路原理图 (10)附2重点部分软件源程序 (10)1 方案论证与比较1.1 处理器的比较与选择方案一:采用传统的8951或8952机型单片机,外接两级运算放大电路放大采集信号,在单片机输入端口外加一路模数转换器AD0838,把测量到的角度转换成数字信号,输入单片机,经过运算控制步进电机的转角,控制平板的转动状态。
方案二:采用C8051F410混合信号微处理器,内部集成采样率200ksps的12位AD、24.5MHz的内部晶振、12位的DA转换器和32K的内部FLASH。
方案一采用传统单片机和设计方法,包含电子设计中的基本步骤,外围接口电路复杂,器件多,焊接和调试工作量大,软件设计繁琐,开发周期长。
方案二使用了集成度较高的处理器,AD、DA和晶体振荡器等都是内部集成,外围接口电路设计简单,而且指令系统中大部分指令都是单周期指令,执行速度快,指令周期短,最高可以运行于98MHz的工作频率,对连续变化的信号处理具有更好的实时性。
因此根据大赛时间短、任务重的情况,我们采用方案二中的混合信号处理器。
1.2 摆角测量方法比较与选择单摆在摆动过程中,下端的平板也做连续的变化,且系统要求能够测量摆杆的位置并控制平板的状态,一般的角度传感器采样周期较长,反应速度较慢,高精度高速的角度传感器在比赛期间内不易找到,普通的又不能实时控制平板的平衡状态。
若使某种机械装置能与摆杆同步变化,且变化量易于测量,则可近于连续的测的单摆的当前摆动状态及平板的当前偏离状态,测量精度得以保证,控制更加有效。
鉴于此,本系统的测量部分使用旋转式电位器,它的转动与摆杆的摆动相同步,电位器上的电压变化反映了摆杆的当前位置,即单摆的摆角,再根据系统的不同功能,计算出平板的调整值,进而控制步进电机达到控制平板的目的。
1.3 平板控制方法比较与选择自由摆在震动过程中,由于受到重力作用,摆杆的角速度与时间不是线性关系,而底端平板的调节必须根据摆杆角度来做相应的调整,所以,平板的调节速度也不是线性的在平板转动过程中,由于角度在不断变化,且变化角度是非线性关系,故测回来的转角也不是线性变化的。
但是单摆的摆动速度不是很快,并且单片机的计算速度比较快,用拉格朗日插值法计算过程复杂,延时较长,不利于实时控制,故本系统采用线性插值的方法对步进电机进行控制。
先将测得的值进行整型处理并取其绝对值,再在插值表中比较出与该值最接近的给定值,根据线性插值定理可计算出当前角度和变化率下的步进电机转动的节拍数,再由机械几何结构计算出平板转动的精确位置。
2 系统设计2.1 总体设计自由摆系统中,摆杆在静止时的状态,将平板调节到水平,我们将该状态设定为系统控制的初始状态,后期的平板调节角度就以该初始状态作为计算基准。
摆杆摆动时会同步的带动电位器旋转,电位器的旋转就会引起电位器滑动端输出电压的变化,将这个变化的电压经过信号处理后送入单片机的AD 输入引脚,这样经过单片机内部的AD 转换器,就会得到一系列变化的AD 码。
在本系统中,摆杆所在不同的位置的会得到不同的AD 码,但是每一个AD 码会与摆杆的某一固定位置相对应,这样,程序就可以根据采集到的不同AD 码来控制步进电机,调节旋转平板的角度,以实现设计中的不同要求。
系统运行的不同功能可以通过按键进行选择,这里采用通用的4按键设计,所有的功能选择与系统运行状态可以通过液晶屏实时地显示,系统设计的整体框图如图1所示。
图1 系统总体框图2.2 机械结构设计2.2.1 支架设计支架由平底木板、铁架、支木、横梁和轴承组成。
平地木版保证支架在自由摆摆动时整个支架稳定不晃动。
铁架长1.35m ,为衡量提供所需的高度,横梁作为固定轴承,电位器,及摆杆的着力点,整个结构利用机械的平衡性和三角形的稳定性,保证单摆在做自由摆动时,不会在前后左右的四个方向上晃动,增加了整个支架部分的稳定性及美观性,为平板的精确测量提供了保证。
2.2.2 摆杆设计摆杆由上端的金属螺丝轴,摆杆,下端的步进电机三部分组成。
摆杆固定在直径为8mm 的螺丝轴上,螺丝轴穿过由2个轴承构成的水平同轴心孔内,这样就使得摆杆在左右方向灵活转动,而不会产生前后的震动。
步进电机镶嵌在摆杆中,增加了步进电机和摆杆的稳定性,也实现了对旋转平板的精确控制。
电机的转动轴上固定一块电位器 信号处理 按键选择 液晶显示平板状态步进电机 自由摆摆角单片机平板,用来放置硬币及安装激光笔。
摆杆在自由摆动时做往复的单摆运动,单摆的周期计算如下:gT d 2π= (1)其中d 为摆杆长度,计算得出本系统的单摆振动周期约为2s ,2.3 系统硬件单元设计2.3.1 单片机最小控制单元C8051F410 MCU 是新华龙公司出品的8位多功能单片机,除含有传统51单片机所有的特点外,它还具有时钟频率高(24.5MHZ),可以在系统仿真等特点,在倍频时,其时钟频率可达98MHZ ,计算速度快,指令周期短,本控制系统采用这款单片机制作控制单元。
最小控制系统的电路原理图如图2所示。
Vregin 8P 1.0/X T A L 19GND 6VDD 7Vio1RST/C2CK 2Vrtc-backup 3XTAL44XTAL35P 1.1/X T A L 210P 1.2/V R E F 11P 1.312P 1.413P 1.514P 1.615P 1.716P0.0/IDAC017P0.1/IDAC118P0.219P0.320P0.4/TX21P0.5/RX 22P0.6/CNVSTR23P0.724P 2.025P 2.126P 2.227P 2.328P 2.429P 2.530P 2.631P 2.7/C 2D 32C8051F410/212Power1Header 2VCC104C1VCC VCCVDD GND 1K104C2100uFC7VCC1K RSTSW1100uFC6VDDRST104C3100uFC8VREF 100uFC5VCC A_INB_IN C_IN D_IN图2 C8051F410最小系统电路图中电容C1,C5构成滤波电路,为单片机提供尽可能稳定的供电电压;P1.2为复用端口,当对相应的寄存器作相应的配置时,为外部提供一个 2.2V 的电压基准;P0.0、P0.1、P0.2、P0.3作为步进电机控制信号输出端口,通过输出不同的相续,从而控制电机的转动。
P0.4为ADC 转换器输入端口,P2.0、P2.1、P2.2、P2.3为液晶输出端口。
P1.3、P1.4、P1.5、P1.6为键盘输入端口。
2.3.2 摆杆位置的测量系统中测量转角的电位器采用最大值为10K 的旋转式多圈电位器,此电位器具有较好的线性度,其转过的角度与其电阻变化值成正比。
变化电阻的阻值记为,R ∆摆在平衡位置时电阻的阻值记为R 0,电流为I ,送给放大电路的电压为u ,线性关系函数为:)(f θ∆=∆R(2)则有0)(f R R +=θ(3) I R I )(f I ]R )(f [ RI u 00+⨯=⨯+==θθ(4)即电压正比于转角。
采回来的电压信号并不是全量程都在AD 转换器的允许输入范围内,还需经过电平处理才可送入处理器的ADC 输入通道进行转换,我们的电路使用的运算放大器为OP07芯片。
电路的第一,二级均为电压跟随器,设第一级输入电压为V i1,输出为V o1,第二级输入电压为V i2,输出为V o2,则有V i1=u (5)V o1=V i1 (6) V i2=V o1/2(7) V o2=V i2=V i1/2(8)倾角电压信号处理的电路如图3所示。
图3 倾角电压信号处理被调整的信号经过R7和C4构成的RC 滤波电路,滤波后的V o2通过P0.4送入AD 转换器进行转换,从转换后的AD 码就可以确定摆杆的位置,进而对旋转平板完成相应的控制与调节。
2.3.3 平板状态控制单元自由摆系统中,在摆杆静止状态时给定旋转平板一个初值,使其处于水平状态,这个状态称为初始状态,在摆动过程中,通过测量摆杆的运行位置,从平板的初始状态对其进行实时调整。
平板是直接受步进电机的控制而正向或反向旋转的,步进电机是将电平脉冲信号转变为角位移或线位移的开环控制元步进电机件。
当步进驱动器接收到一个脉冲信号,它就驱动步进电机按设定的方向转动一个固定的角度,它的旋转是以固定的角度一步+5100uF85234671U1OP071KR81KR9-5100uF85234671OP07+5-510KR70.01uFC4P0.4V i1V o1V i2V o2一步运行的。
可以通过控制脉冲个数来控制角位移量,从而达到准确定位的目的,同时可以通过控制脉冲频率和脉冲电压的高低来控制电机转动的速度和加速度,从而达到调速的目的,在本系统中采用24V 驱动的步进电机,它具有较大的转动力矩和较快的加速度。
步进电机驱动采用ST 公司的TIP142达林顿管,TIP142是NPN 型单片大功率达林顿晶体管,经常做大功率器件的开关管,它的集电极I C 电流最大值为10A ,完全可以满足驱动步进电机的要求。
步进电机可以工作在四相八拍的运行方式,即A-AB-B-BC-C-CD-D-DA-A ,驱动电路如图4所示。
1KR3A_OUTQ1TIP142A _I N1KR4B_OUT Q2TIP142B _I N1KR5C_OUT Q3TIP142C _I N1KR6D_OUT Q4TIP142D _I N图4 步进电机驱动电路2.3.4 人机接口单元人机接口单元由键盘和nokia5110液晶显示器组成。