电子设计竞赛论文-基于自由摆的平板控制系统.doc

12011年全国大学生电子设计竞赛基于自由摆的平板控制系统B甲01310学校名称山东理工大学参赛学生指导教师1摘要本设计以STM32作为基于自由摆的平板控制系统的中央控制单元，应用角度传感器、重力加速度传感器，步进电机和NRF24L01无线通信等模块，通过数据的高速采集、传输、AD转换和数据处理获取摆杆的摆动情况，再利用单片机的PWM模式对步进电机进行控制，从而实现平板平衡，使硬币在摆杆摆动过程中不从平板上滑落，并完成了激光笔定位功能。本设计以高速度，高灵敏度和高稳定性为设计目标，达到了题目的基本要求和发挥部分的要求。关键词STM32；加速度传感器；电机；自由摆；角度传感器ABSTRACTTHEDESIGNAPPLIESSTM32ASTHECENTRALCONTROLUNITOFTHEFREESWINGBOARDCONTROLSYSTEM,WITHOTHERMODULESSUCHASANGLESENSORGRAVITYACCELERATIONSENSORSTEPPINGMOTORANDNRF24L01WIRELESSTRANSMISSIONMODULEBYACCESSINGTHESWINGDATAOFTHESWINGINGRODTHROUGHHIGHSPEEDDATACOLLECTION,TRANSMISSION,ADTRANSFORMANDDATAPROCESSING,THENDRIVINGTHESTEPPINGMOTORCONTROLLEDBYSCMPWMTOHOLDTHEBALANCEOFTHESWINGBOARD,KEEPINGTHECOINFROMFALLINGOFFTHESWINGBOARD，FINISHEDTHEALLOCATIONUSINGTHELASERPOINTERONTHEPAPERTHEDESIGNAIMSTHEHIGHSPEED,HIGHSENSITIVITYANDHIGHSTABILITY,ANDFULLYREALIZEDTHEBASICREQUIREMENTSANDPARTLYOFEXERTIONOFTHECOMPETITION2KEYWORDSTM32ACCELERATIONSENSORSSTEPPINGMOTORFREESWINGBOARDANGULARVELOCITYSENSOR目录摘要1ABSTRACT1目录21各模块方案选择与论证311主控制器方案选择3312通信方案选择313重力加速度传感器的选择414驱动电机的选择415支架材料的选择42理论分析与计算421总体方案422建模与控制方法53单元模块设计931主控制单元模块932重力加速度检测模块1033角度检测模块1134电机模块1235STM32无线传输模块124软件设计135测试方案与测试结果136设计总结167参考文献16附录174基于自由摆的平板控制系统本设计是自由摆平板控制系统，主要由主控制器、角度传感器、重力加速度传感器，电动机和NRF24L01无线通信等模块组成，各个模块的选择与论证方案如下1各模块方案选择与论证11主控制器方案选择方案一采用超低功耗单片机MSP430单片机作为控制器。MSP430单片机具有较高的处理速度，中断源较多，并且可以任意嵌套，使用时灵活方便。但是该单片机通用性较差，性价比相对较低。故我们放弃此方案。方案二采用51系列单片机，51单片机是比较常用的8位单片机，MCS51以其典型的结构和完善的总线专用寄存器的集中管理，众多的逻辑位操作功能及面向控制的丰富的指令系统，开发简单，价格低廉，通用性好等特点被人们广泛的应用于各种控制电路中。它拥有基于复杂指令集（CISC）的单片机内核，但是其速度不快，12个振荡周期才执行一个单周期指令，适合应用于小型的控制领域和精度要求不高的环境中，由于其速度比较慢，因此在用于速度要求高的地5方，51单片机并不是最佳的选择。此外，51单片机的耗电也比较大。方案三采用32位的STM32开发板作为系统控制器。集成多通讯接口、功能丰富，性能稳定、可靠，可以实现系统的多功能控制，可以进行高速的数据采集和处理以及对电机的控制，能够达到题目的所有要求。对比以上三套方案，综合单片机的性能和系统运行速度及功能的实现效果，选用方案三进行题目设计。12通信方案选择方案一采用RS232串口通讯。出现时间较早，较为通用，也存在但接口信号电平值较高，易损坏接口电路的芯片，传输速率较低，抗噪声干扰性弱，传输距离有限等缺点。方案二采用SPI总线。SPI总线通信具有高速同步串行口，收发独立、可同步进行等优点，但是接口较多，线路连接较为接复杂。方案三采用CAN总线，传输可靠，实时性高；传输距离较长，传输速率为较快，有应答位，以保证信息快速正确送达；缺点是传输速率与传输距离相互限制，且波特率降低。方案四采用无线传输，无线传输速度快，无需实际线路的铺设。综合考虑，选用方案四进行通信，可以避免线路对自由摆的影响，方便，高效。613重力加速度传感器的选择方案一电阻式重力加速度传感器，它测量范围广,寿命长,结构简单，但是对于大应变有较大的非线性、输出信号较弱。方案二采用电容式传感器MMA7260加速度传感器，具有稳定性高、功耗低、过载能力强等优点同时可以输出XYZ三个方向与加速度的电压模拟量，还有2到8G四档量程，并且灵敏度可选。考虑到方案对灵敏度的选择，以及技术的可实现性，选用方案二进行重力加速度的测量。14驱动电机的选择方案一步进电机对位置的控制是有优势的，即可以停在较为准确的位置。容易实现对电机转动的准确控制。方案二直流电机。直流电机力量大能获得较大的启动转矩但只能对转速进行控制，但无法控制电机的停止位置，所以用在一引起位置要求严格的产品上，还是有引起问题的。方案三伺服电机。伺服电机能够实现位置，速度和力矩的闭环控制但控制较为复杂，电刷换向,速度限制,附加阻力。为了满足题目要求，选用方案一。15支架材料的选择方案一塑料，硬度差，易变形。方案二金属材料，密度大，硬度大，但可塑性低，价格较高高，焊接困难。方案三木质，密度适中，硬度适中，可塑性强，价格便宜，取7材方便，连接较容易。综合比较上面三种支架材料的密度、可塑性以及成本等方面，以及考虑到考虑题目要求，采用方案三实现。2理论分析与计算21总体方案本系统以STM32作为主控制单元，由重力加速度传感器和角度传感器采集自由摆的摆动情况，经过A/D转换和数据处理，根据摆动情况来确定平板所需的转动角度，通过PWM控制步进电机，调整角度来保持平板的平衡。总体的原理框图如图1所示。图1系统整体框图数据的A/D采集和处理无线通信加速度传感器电动机STM32从机STM32主机角度传感器822建模与控制方法（1）单摆运动状态测量方法当摆动角度小于50的情况下，摆所受的力矩M为MGLM（1）式中M与的关系，恰似弹性力F与位移X的关系，根据转动定理，单摆的角加速度为2DTJJMGLDT2（2）式中J是摆锤对悬挂点A的转动惯量（），因此，上式可2JL写成LGDT2（3）当单摆在角位移大于的情况下,由于不能近似等于,所以05SIN单摆的公式应写成0SIN20DT（4）式中的表示角频率。将展开为级数0SIN53I（5）9取上式代入式（4），得6202DT（6）这是非线性方程，很难求得精确的解析解，但研究表明可以应用迭代法求地其一次近似解为TAT03COS192CS（7）其中，式（7）表明，此时摆的运动不是单一的简谐1620A运动，而是一种较为复杂的振动，即它是由两中振动组成的合振动。（2）系统控制策略自由摆的运动是连续运动，摆末端平板的变化也是一个连续的渐变过程，在连续的闭环过程控制中，采用按偏差的比例P、积分I、微分D进行控制的PID控制技术，采用PID调节器的控制系统如图2所示。由图中可以看出，比例、积分和微分控制作用是并联的关系，参数可以分别调节，也可以只采用其中的一种或两种控制规律。图2PID控制系统101）PID调节器的微分方程TDIPDTETETKTU01（8）式中TCRTEPID调节器的传输函数STKSEUDDIP1（9）2）PID调节器各校正环节的作用比例环节成比例地反应控制系统的偏差信号ET，偏差一旦产生，调节器立即产生控制作用以减小偏差。积分环节主要用于消除静差，提高系统的无差度。积分作用的强弱取决于积分时间常数TI，TI越大，积分作用越弱，反之则越强。微分环节能反应偏差信号的变化趋势变化速率，并能在偏差信号的值变得太大之前，在系统中引入一个有效的早期修正信号，从而加快系统的动作速度，减小调节时间。3）数字PID控制算法为了便于计算机实现PID控制算式，必须把微分方程离散化，改写成差分方程。数字PID控制器的差分方程001UNUNUNETIEKDIPNIDI（10）11式中，第一项起比例控制作用，第二项起积分控制作用，第三项起微分控制作用。根据式10写出第N1时刻的控制量UN1,即010211UNETIENEKNUNIDIP（11）两式相减得到第七时刻的控制量的增量为2121NENETNEKNUDIP（12）式12所计算的结果反映了控制器的第N次和第N1次输出之间的增量。增量式控制虽然只是算法上作了一点改进，却带来了不少优点由于计算机输出增量，所以误动作时影响小，必要时可以用逻辑判断的方法去掉；由于只输出本次的增量，与初始位置无关，因而有利于实现手动到自动的无扰动切换；算式中不需要累加，不会引起累计误差。（3）准确跟踪目标得非线性误差修正算法影响测量结果不精确的因素很多,如元件的实际参数、温度特性、抗干扰性能等等，所以需要相应的软件进行修正。测量电压与倾角的关系不是纯粹的线性关系。因此需要采取某种数值计算方法，通过建立函数关系，将两者之间转变为线性关系，利于处理器对其进行实际的测算，即进行软件矫正。本文选择函数修正法中的线性拟合修正法12对其进行矫正。线性拟合算法的基本原理在传感器输出的曲线中，当其为直线运动，设采样点坐标为（）K1,2N,利用直线运动原理，拟YX,合出直线方程YAXB,利用最小二乘法求解参数A、B，确立直线方程，用此函数预测目标未来时刻的值。利用最小二乘法拟合直线方程的参数的基本原理是使得拟合的残差平方和Q最小，Q的表达式为NKKBXAY12（13）上式分别对A、B求导数得NKKBXAYAQ12（14）NKKKBXAYXB12（15）分别令，则可求出拟合参数为0AQBXBYAXYNKKK,12（16）其中，。NKX1/NKY1/由于线性拟合算法只适用于运动轨迹为直线的情况，当运动轨迹13为曲线时，线性拟合算法并不适用，这是把线性拟合算法加以推广，采用分段线性拟合法。分段线性拟合算法的思想与线性拟合算法基本相同，都是利用历史数拟合成直线方程，与线性拟合法最大区别在于它的直线参数不是固定的，而是随着目标的运动而不断更新拟合直线参数。设传感器在第K,K1点时测量得到的坐标分别为（）,KYX,利用最小二乘法得到拟合直线参数,则建立的拟合直线方1,KYXKBA程为，用此方程可以预测出目标在K2时刻将要到达的位KBXA置，而当目标运动到K2时刻时，为了预测目标在第K3时刻将要达到的位置，可以建立新的拟合直线方程，这就是分段拟合1KKBXAY算法的基本过程。用这种方法进行轨迹与测时，即使是缓慢变化的非平稳过程，也能做到随时统计数据变化而变化，达到准确跟踪目标的目的。3单元模块设计31主控制单元模块主控制单元模块（包括主机和从机）如图3、图4所示，采用32位的STM32芯片作为系统控制器。集成多端口通讯接口、功能丰富，性能稳定、可靠，可以实现系统的多功能控制，可以进行高速的数据采集和处理以及对电机的控制。1412LDREDC0UF/V34K5GN_POWEINOTUT76PASBMI89XHZLASHRYJB一充Q图3主控制单元模块（主机部分）YK图4控制单元模块（从机部分）1532重力加速度检测模块重力加速度传感器能够感知到加速力的变化，重力加速度检测模块由电容式传感器MMA7260加速度传感器和少量外围元器件构成。MMA7260电路图如图5所示，重力加速度检测模块原理图如图6所示。POWERSULYVDLEPMODGCT12XUZH0A/INRMCGN图5MMA7260电路图16图6重力加速度检测模块原理图该部分中采用电容式传感器MMA7260加速度传感器，传感器工作在33V电压下，将传感器送来的角度对应的电压信号经过放大送入STM32单片机；在STM32单片机内A/D转换，对数据进行处理，将数字化电压信号转化成为对应的角度值；最后，单片机根据采集的信息控制电机对平板进行调节，实现平衡33角度检测模块POWERSUPLY524VGNDECUANGTOSR图7角度编码器电路图角度编码器电路图如图7所示，编码器是将信号或数据进行编制、转换为可用以通讯、传输和存储的信号形式的设备。角度编码器把角位移换成电信号，这样不同的角度对应不同的电压值，此角度编码器放在自由摆的上部，用于检测摆杆摆动的角度，和重力加速度传感器相配合，以便准确检测角度。为单片机驱动电机提供较为准确的依据。34电机模块电机的转子为永磁体，当电流流过定子绕组时，定子绕组产生一17矢量磁场。该磁场会带动转子旋转一角度，使得转子的一对磁场方向与定子的磁场方向一致。当定子的矢量磁场旋转一个角度。转子也随着该磁场转一个角度。每输入一个电脉冲，电动机转动一个角度前进一步。它输出的角位移与输入的脉冲数成正比、转速与脉冲频率成正比。改变绕组通电的顺序，电机就会反转。所以可用控制脉冲数量、频率及电动机各相绕组的通电顺序来控制步进电机的转动。这样，就能够很精确的控制电机的转动，从而实现精确的定位，可以很好的保持自由摆平板的平衡。电机的驱动电路如图8所示，它是平衡控制系统的核心是实现系统闭环的关键环节，它接收角度传感器反馈的角度数据，进而根据给定的控制算法计算出控制量，输出后控制电机的转动维持系统的平衡，同时，控制驱动模块需监控电机的运转情况，通过软件实现最佳位置控制。图8电机驱动电路1835STM32无线传输模块NRF24L01无线模块通过SPI接口和外部控制器件ARM进行数据交换，NRF24L01是单片射频收发芯片，工作于2425GHZ国际通用ISM频段。工作电压为1936V，有多达125个频道可供选择。有极低的工作电流，掉电模式和待机模式时电流消耗更低。可通过SPI写入数据，最高可达10MBS，数据传输率最快可达2MBS。4软件设计系统软件是在STM32开发环境下，采用C语言和汇编语言混合编程。程序总体流程图如图9所示。是否角度变化N角度变化值AYA0开始电机左转电机右转调整完毕NY电机停转初始状态NY初始化是否偏离中心线偏离中心距离值DNYD0电机左转Y电机右转N调整完毕N电机停转激光笔测试硬币测试图9总体程序流程图195测试方案与测试结果51测试仪器测试仪器如表1所示表1测试仪器编号仪器型号仪器名称001YB1719A直流电源002秒表003量角器004直尺52测试方法、结果及分析（1）静态性能测试用手推动摆杆摆起一定的角度（在3045间），利用倾角传感器提供的当前平板与水平位置的角度，处理器计算出恢复平衡位置所需要的脉冲个数并发送给步进电机，电机收到驱动信号后带动平板反方向转动，到达平衡位置时停止转动。反复调整，确定使步进电机能迅速反应且稳定工作的运行频率，使平板能尽快恢复水平状态。（2）动态性能测试用手缓慢推动摆杆至一个角度（在4560间），待平板达到水平后释放，让摆杆作自由摆动直至停止，在摆动过程中使平板保持水平状态。平台能在要求范围内迅速响应。20表2平板角度偏差角度6050403020100102030405060角度偏差019023021045041054034028053029035013039经过测量在静态和动态测试中平板角度偏差都保持在一个较小的水平，可以达到题目要求（3）触板硬币数实验用手推动摆杆至一个角度（在4560间），调整平板角度，在平板中心稳定叠放8枚1元硬币，启动后放开摆杆让其自由摆动。在摆杆摆动过程中，使硬币在摆杆的5个摆动周期中不从平板上滑落，并保持叠放状态。触板硬币数如表3所示。表3触板硬币数实验次数123456789触板硬币数110110010经过实验和调试已经可以达到很高的成功率。（4）激光笔的调整21图10相关角度的计算自由摆摆动的角度和激光笔与测试纸之间的夹角有一定的关系，要想使激光笔的照射位置不变，可以保持使YARCTAN1COSX/15SINX，这样可以通过传感器采集数据使X与Y保持上式关系，单片机控制电机使平板保持一定角度，从而实现目标。由于平板和激光笔本身厚度的存在，这样计算存在一定的误差，这样需要根据实际情况对结果进行相应的微调。试验数据如表4所示。表4试验角度和偏移距离和时间的关系试验角度010152025303540455055时间S566912957109偏移距离（MM2257856455（5）倾角与电压转换关系测试倾角传感器部分经调零和定标后，为了测试其测量的准确性，先针对不同角度得到其输出特性曲线。因为本设计的自由摆平衡装置摆22动的角度在600600之间变化，所以选择在区间一600600每隔50采集一组20个数据，测量结果附录3所示。图11测量电压与倾角的关系曲线测量电压与倾角的关系曲线如图11所示，从测量电压与倾角的关系曲线可以看出，两者之间不是纯粹的线性关系。6设计总结经过了几天的拼搏，我们组的三个成员都感受到，这次比赛对于我们的毅力和意志力是一个重要的考验。我们用STM32作为控制系统的中央控制单元，应用角度传感器、重力加速度传感器，步进电机和NRF24L01无线通信等模块，通过数据的高速采集、传输、AD转换和数据处理获取摆杆的摆动情况，再利用单片机的PWM模式对步进电机进行控制，从而实现平板平衡，使硬币在摆杆摆动过程中不从平板上滑落，保证了基础功能的顺利实现。本设计以高速度，高灵敏度和高稳定性为设计目标，完全达到了题目的基本要求和发挥部分的要求。23当然，我们的设计还存在一些缺陷，有待在将来的学习中进一步提高，在此我们要感谢我们的指导老师。也在此恳请各位老师批评指正。7参考文献1张新义微型计算机原理与接口技术M,机械工业出版社20082李宁基于MDK的STM32处理器应用开发,北京航空航天大学出版社,2008103周立功等ARM嵌入式系统基础教程,北京航空航天大学出版社,2005014秦伟基于ARM处理器的数据采集系统的设计J自动化技术与应用,2006105陈永甫红外线探测与控制电路M,人民邮电出版社,2004066谭博学，苗汇静集成电路原理及应用北京电子工业出版社，20087清华大学电子学教研组模拟电子技术基础简明教程M北京高等教育出版社，19858黄智伟全国电子设计竞赛电路设计M北京北京航空航天大学出版社，20069黄智伟全国大学生电子设计竞赛制作实训M北京北京航空航天大学出版社，200724附录1整机电路图2LDREDC0UF/V34K5GN_POWEINOTUT76PASBMI89XHZLASHRYJB一充Q25C210PFGND48X376BOT9RS_IUPA/WKMHE5JLLVNYZASHKEY充QTRODGCUZIM26POWERSUPLY524VGNDECUANGTOSR272部分程序代码VOIDF_MOVEVOIDM1_LM2_LM3_HCWB_HEN_H/DELAY0XFFF/EN_L28VOIDB_2_MOVE_2VOIDM1_LM2_LM3_LCWB_LEN_HDELAY0XFFFEN_LVOIDF_4_MOVE_1VOIDM1_LM2_HM3_HCWB_HEN_H29DELAY0XFFFEN_LVOIDF_4_MOVE_2VOIDM1_HM2_LM3_LCWB_HEN_HDELAY0XFFFEN_LVOIDLCD_WR_REGU16INDEX,U16CONGFIGTEMPCLR_CSCLR_RSSET_NRD30DATATOWRITEINDEXCLR_NWRSET_NWRSET_RSDATATOWRITECONGFIGTEMPCLR_NWRSET_NWRSET_CS3倾角与电压转换关系实验电压（V）倾角（）12345678910平均值60104510351057107110511046104710571039106210501048106010451043106210541039105610501051551151114911381138114511491152114811401135115131114811611411126113411541134113013551138501251216124612331244121012201233122712251224121112071209121712341224121312331228123545131313211314131713241326131813151309132513161317132013131305132113041308131413151311401397138214121456144914611431144514551445142914511396137713641452145614441463142314113514681475145814821482147614751473148314601471147214871463147514561443148114671471147230148514821491149015111513151815231506150215091515141414151515151532211959899131718121625153215391536154215391536153815391538153415381534153315421543154715441541535153315412015611564156315641559159215451552156115551570157815771578154915841565158415691589158715159316131619159716071605160616071605161516101611161216091609161316211617161416131614101635163216371634163116321635163116421641163516361635163316361632163416331637163816345165316551656165316541651165216531647165116461648164616531657165916516581653165116463301676167816671673167716751678167316801678167716731676167916761669