技术控做的玩具就是酷,小车跷跷板平衡控制系统设计,完整解决方案
项目背景及可行性分析
- 项目名称、项目的主要内容及目前的进展情况
项目名称:基于FPGA的小车跷跷板平衡控制系统设计
项目主要内容:
本项目以FPGA为核心,制作一个电动小车控制器,使小车能够自动沿一个宽30cm,长160cm的翘翘板寻迹行驶,并能调节小车位置使翘翘板倾斜某一设定角度,保持静止平衡。当另有外力使翘翘板失衡时,小车自动寻找新的平衡点,使翘翘板重新达到平衡。如图1、图2所示。系统静态误差小于1度,超调量小于10%。项目制作中,将通过理论研究和反复实验对控制算法和控制参数进行优化力求达到最快调节速度和最小误差,为控制工程提供一个真实的物理仿真实验装置。
图一
图二
目前的进展情况:
本项目于前期已做了较为充分的理论准备工作,经过理论推导,建立了受控对象和控制系统的数学模型,研究和比较了系统的相关控制算法。项目车体部分、光电传感器部分、电机驱动部分、角度传感器部分、信号调理放大电路、电机驱动电路、系统供电电路等部件均已设计制作完成,有关的外围电路印制板也已焊接调试成功,并分别通过调试。目前正在对系统进行优化和改进,并着手编写程序,待获得FPGA开发平台后,即可开始程序调试及系统联调实验。
- 项目关键技术及创新点的论述:
本项目的关键技术在于利用FPGA的快速数据处理功能和丰富灵活的接口资源,建立一个能对小车翘翘板系统进行控制的硬件平台,在此基础上研究各种控制算法,应用实验平台对控制算法进行验证,对翘翘板的非稳定平衡状态进行有效的控制,使之处于平衡静止状态并能够保持。本项目的受控对象是一个非线性高阶系统,在控制领域中是人们感兴趣而又难以被控制的过程,其相关研究结论可应用于飞行器姿态控制、机器人平衡控制等方面,涉及非线性信号处理、非线性控制、控制参数自动优化等技术。
本项目的创新点在于,把FPGA的高速并行数据处理特性综合应用到了一个在控制领域中人们所感兴趣而又难以被控制的非稳定受控过程中,利用FPGA为控制系统研究提供了一个通用性好,廉价而实用的实验平台,为理论研究结果建立一个实验物质条件,增强理论和实践的相结合。同时,该项目富有趣味性和知识性,可以激发更多电子爱好者的兴趣,扩大FPGA的应用层面。
- 技术成熟性和可靠性论述:
小车平衡态的控制类似于倒立摆,但又有所不同。倒立摆控制已经有较多的研究,并已应用于机器人平衡,飞行器姿态控制等。理论和实践都证明系统是可实现的。小车的控制采样周期大约毫秒数量级就可满足基本要求,所以,FPGA的速度完全可以满足要求。而FPGA所具有的灵活的逻辑组合配置,足以完成小车运行所需要的控制逻辑和运行协调。系统所使用的各传感器及其信号调理电路已经调试成功。这些先行工作和已成熟技术为系统的成功实现提供联保证条件。在可靠性方面,系统各部件之间的连接将采用高可靠的连接器件,并用热封胶密封,机械紧固件采取锁紧措施。由于系统不与外界电气连接,不存在共模电压干扰,因此不考虑使用光电隔离。在软件方面,采用看门狗定时器,保证系统程序跑飞后能够自动恢复运行。
图3
项目实施方案
- 方案基本功能框图及描述
系统框图如图3所示,主控循环程序每隔一个采样周期从FPGA接口中读取各个传感器的数值,并经过处理后获得小车的运行状态,根据小车的当前状态采取相应的控制算法计算出电机所需的控制电压值,进而,该控制电压值经过PMW处理后输出到小车驱动电机,使小车按照希望的规律运动。为了使程序流程清晰简洁,框图中以一个标志信号来记录小车所运行的阶段,控制器则根据小车所处的运行阶段进行相应的控制。
2.需要的开发平台
根据本系统所需达到功能要求和性能要求,系统需要完成传感器模拟量的数据采集和光电传感器电平数据的采集,需要对采集的数据进行处理和输出,需要对小车的状态进行判断和控制等。Spartan-3E芯片(XC3S500E-4FG320C)具有速度高,接口丰富等特点,根据系统要求和所要完成的功能,Spartan-3E芯片(XC3S500E-4FG320C)配以相应的开发环境,完全可以完成系统控制要求,且价廉实惠,开发过程快捷,简单易行。为了能够使用Spartan-3E初级板,本项目需要与Spartan-3E初级板相配套的开发软件和编译调试工具和环境。
2.方案实施过程中需要开发的模块
在本方案中需要研制、开发的功能主要模块,以及开发的方式
本方案中,所要研制的硬件模块包括:1)寻迹用红外光电传感器模块及其波形整形电路,2)用于检测小车运行位移和速度的红外光电编码器模块,3)用于为不同元件提供不同电压的电源变换模块,4)
平衡控制系统 电动小车控制器 FPGA Spartan-3E 相关文章:
- 在采用FPGA设计DSP系统中仿真的重要性 (06-21)
- 基于 DSP Builder的FIR滤波器的设计与实现(06-21)
- 基于FPGA的快速并行FFT及其在空间太阳望远镜图像锁定系统中的应用(06-21)
- 3DES算法的FPGA高速实现(06-21)
- 用FPGA实现FFT算法(06-21)
- FPGA的DSP性能揭秘(06-16)