2011全国大学生电子设计大赛国家一等奖

《2011全国大学生电子设计大赛国家一等奖》由会员分享，可在线阅读，更多相关《2011全国大学生电子设计大赛国家一等奖（27页珍藏版）》请在装配图网上搜索。

1、2011年全国大学生电子设计竞赛基于自由摆的平板控制系统（B题）【本科组】伽伽怕E的站2011年9月3日本系统以单片机为控制核心，采用增量旋转编码器实时采集自由摆旋转角 度及方向，通过步进电机开环控制平板旋转角度，以实现控制要求。此外，为 方便实验和调试，专门设计了独立的单片机角度显示电路。本设计以旋转编码 器的脉冲触发单片机的中断来控制平板角度的调整，这种外部事件驱动的程序 设计方法能够及时响应摆杆角度的变化，避免了复杂的定时采样程序设计，总 体程序设计简洁，响应时间快，控制精度高。在激光笔瞄准时采用了査表法， 避免了单片机进行复杂三角函数运算造成的舍入误差对实验精度的影响，从而 达到了在一

2、个周期里电机精确旋转一周；平板角度调整速度快，8枚硬币滑动小 无跌落；实时控制激光笔保持静态水平误差在1cm以内；动态控制误差在2cm 以内的实验效果。关键字：外部事件驱动程序设计旋转编码器平板精确控制目 录1系统方案分析11.1.1控制器选用21.1.2控制系统方案选择21.2角度测量模块的论证与选择21.3步进电机及其驱动模块的论证与选择22系统理论分析与计算32.1自由摆平板控制系统的分析32.1.1自由摆平板系统模型建立42.1.2角度测量原理分析52.1.3平板角度的分析52.2角度测量的计算72.2.1单位脉冲转过角度计算72.2.2编码器可行性计算72.3步进电机模块的论证分析7

3、2.3.1步进电机节拍数与螺旋码盘输出脉冲之间关系72.3.2步进电机最大空载启动频率分析与计算73 电路与程序设计83.1电路的设计83.1.1系统总体框图83.1.2整体电路原理图93.1.3显示子系统框图与电路原理图 93.2程序的设计103.2.1程序功能描述103.2.2具体的程序分析设计124测试方案与测试结果134.1测试方案134.2测试条件与仪器134.3测试结果及分析144.3.1测试结果（数据）144.3.2测试分析与结论165.实验总结16参考文献17附录1：电路原理图18附录2：源程序21附录3：主要元器件清单22基于自由摆的平板控制系统（B题）【本科组】1系统方案分

4、析系统设计任务为一种基于自由摆的保持平板平衡的控制系统。基本要求是保持平板 上硬币的平衡滑动小或滑落少，进一步的要求是让平板上激光笔射在靶纸上的光斑偏移 量尽可能小。在实时控制时，对自由摆的摆角、摆速及摆动方向的测量十分关键，平板 角度的控制精度和相应速度也直接决定着最终的控制效果。据此，本系统采用以单片机 为核心的自由摆控制系统主要由以下几个功能模块构成：1、单片机控制模块2、角度测量获取模块3、平板平衡控制模块4、电机驱动模块5、角度值显示模块系统框图如图一所示。图一系统组成框图1.1主控制器件的论证与选择111控制器选用我们选用STC89C51单片机作为控制核心，它具有8k字节Flash

5、, 256字节RAM, 32位I/O 口 线，看门狗定时器，2个数据指针，三个16位 定时器/计数器，一个6向量2级中断结构，全双工 串彳丁口，片内晶振及时钟电路。112控制系统方案选择方案一：采用在面包板上搭建简易单片机系统在面包板上搭建单片机系统可以方便的对硬件做随时修改，也易于搭建，但是系统 连线较多，不仅相互干扰，使电路杂乱无章，而且系统可靠性低，不适合本系统使用。方案二：自制单片机印刷电路板自制印刷电路实现较为困难，实现周期长，此外也会花费较多的时间，影响整体设 计进程。不宜采用该方案。方案三：米用单片机最小系统。单片机最小系统包含了显示、矩阵键盘、A/D、D/A等模块，能明显减少外

6、围电路的 设计，降低系统设计的难度，非常适合本系统的设计。1.2角度测量获取模块的论证与选择方案一：采用加速度传感器加速度传感器采用模拟量输出，需要放大电路及A/D完成角度的测量，由于在传输 回路中模拟信号易受干扰，测量结果容易产生误差，通过数字滤波等技术虽然能够在一 定程度上消除干扰造成的误差，但是，滤波运算增加了 CPU的负荷。方案二：采用电位器作为角度传感器自由摆系统的角度测量也可采用可变电阻器。精密的可变电阻器具易获得、价格低 廉、重复性咼、分辨率咼、咼频响应特性好、易使用等特点。但是可变电阻器也是模拟 信号输出，需要A/D信号的转换，增加系统复杂性，而且安装要求较高，带来了硬件设 计

7、的不便。方案三：采用增量式光电旋转编码器光电编码器是一种角度（角速度）检测装置，它将输入给轴的角度量，利用光电转 换原理转换成相应的电脉冲。旋转编码器具有体积小，精度高，工作可靠，接口数字化 等优点。此外旋转编码器安装较为方便，接口电路较为简单，能够减少系统硬件电路的 工作量。综合以上三种方案，我们选择方案三。最终我们选择了欧姆龙的1000线高精度旋 转编码器E6B2C它测量精度高，分辨率达到了 0.36。13步进电机及其驱动模块的论证与选择步进电动机的驱 动电路可采用配套的高性能步进电机驱动器ZD-6209-V2。 ZD-6209-V2高性能步进驱动器具有集成度高可靠性好抗高频干扰强，并且接

8、口采用超高 速光耦隔离等特点。能够对整步、半步、四细分、八细分、十六细分可调；输出电流线 行可调支持脱机、使能、锁定等功能。最终选定的步进电机型号为42BYG250-48。该电机为两相步进电机，它的步距角仅 为1.8扭矩为0.50N/m，有较高的空载启动频率，在十六细分后能实现0.225的步距角能够满足本系统的控制要求。2系统理论分析与计算2.1自由摆平板控制系统的分析2.1.1自由摆平板系统模型建立（1）建立自由摆运动模型，由于系统是由轻杆和步进电机等组成，相较于步进电 机，轻杆质量很小，可以近似认为旋转臂重心在平板附近，平板沿半径为L的弧长自由 摆动。示意图如图二0F图二自由摆模型示意图m

9、g在最低位置时平板将达到最大速度，因此在不计空气阻力及固定点摩擦力的情况下利用能量守恒定律有:mg （1一 cos（e） = m,得出 v = ；lg（1 -cos（0）在0不超过60 ， l=1.0m的情况下。计算得v=2.236m/s，由角速度与线速度之间 的关系，得出 w = V =2.236rad/s=128/sl自由摆周期计算根据单摆的周期计算公式得单摆周期T=1.986ms（2）使硬币不滑落的模型分析在自由摆在一个小角度时摆动时，自由摆运动模型便是一个化为物理单摆模型。因 在实际中自由摆臂质量集中在端点的电机上，受力分析如图三所示。图三硬币受力模型硬币受到重力mg，板的支持力合外力

10、方向垂直与摆臂，大小为F合。根据单摆的物理规律平板随自由摆摆臂运动的加速的a方向将始终垂直与摆臂，为 保证平板上硬币不会滑落平板需要保证硬币在沿平板方向上没有分力的作用，也就是硬 币与平板是没有摩擦力的。也即平板对硬币力的作用方向始终在垂直于平板方向上，当摆角30 -45。之间时，经过推算，硬币会受到平板沿平板方向上微弱的分力作 用，但是考虑到两者之间的摩擦力作用，静摩擦力要远大于沿平板方向分力作用，是不 会使硬币发生位移。因此只要保持平板与摆臂的垂直就能保证硬币不会滑落。自由臂开始运动时平板保持水平位置，而要保证硬币不从平板上滑落则需要平板尽 快保持与自由臂垂直，因此在放开平板时需要让平板带

11、动硬币尽快达到与自由臂垂直位 置。2.1.2判断正反转原理分析角度测量模块由高精度旋转编码盘构成，编码盘转轴随自由摆旋转臂转动，当旋转 臂摆过一个角度后旋转编码盘将输出一串脉冲通过对脉冲的计数可以算出转臂摆过的 角度。旋转编码的输出信号A、B时序图如图四所示。当转轴正转时A相输出脉冲超前B相输出脉冲，反转时则相反。通过单片机检测A、 B相输出脉冲的相位关系可以精确地判断自由摆臂的正反转。正转反转A相超前B相A相滞后B相图四旋转编码器判断正反转B相2.1.3自由摆旋转角度与电机旋转角度关系建模与分析对于基础部分，为使硬币不从平板上滑落，需要保持平板始终垂直与自由摆臂垂直, 而在初始时刻，平板保持

12、水平，与自由摆臂夹角达到30-45左右，为保证硬币不滑落, 需要在自由摆开始摆动时刻步进电机控制平板尽快达到与自由摆臂垂直位置。而在以后 的摆动过程中，保持平板方向不变便能满足硬币不滑落的要求。对于发挥部分，由图五可知，在摆杆在靠近平板位置:AB=2sin(0/2)AM=1.5m有正弦定理有:1.5sin(a)sin( + a)2sin()所以:3(tan(ZABM)cos( )+sin()=4sin( )tan(ZABM)2 2 2得出:tan(ZABM )=3sin()24sin() 一 3cos()2 2转过角度:P =n+-ZABM2当摆杆在远离平板位置时，同理:BA6m03sin()

13、tan(ZABM )=14sin() + 3cos()2 2转过角度:B =ZABM + 2图五 自由摆旋转角度与电机旋转角度关系根据上述公式，可以算出旋转编码器脉冲数与步进电机转动脉冲数对应关系，几个 主要的对应关系如表一所示。激光笔M :右侧左侧编 码 器 脉 冲 数自由 摆臂 度数平板调整 角度8细分 步进电 机对应 脉冲数16细 分对 应脉 冲数编码 器脉 冲数自由 摆臂 度数平板调整 角度8细分 步进 电机 对应 脉冲 数16细 分对 应脉 冲数000000000010.360.3606422310.360.0062962420.720.7228113620.720.01261936

14、31.081.08652651031.080.018967510 8430.2438.004781693388430.240.5956152304 1254565.25342290580125450.917334234468 16760.1298.4976943887616760.121.2582320640 17261.92102.479745591117261.921.2993393316622.2角度测量的计算2.2.1单位脉冲转过角度计算根据旋转编码器的精度指标，旋转一周为360，每一个脉冲为旋转0.36，通过 获取旋转编码器的脉冲数目n从而得到旋转角度值是n*0.36。旋转编码器的脉

15、冲式送到单片机的外部中断口，从而记录脉冲的数目。2.2.2编码器可行性计算根据单摆的可能出现的最大角速度计算系统中可能的最小脉冲周期1 / maxT=厂，其中e为编码器分辨率，为0.36。计算得T=2.8ms,而采用12M晶振的单片机对脉冲计数的周期仅为1p s,远远小于 T,因此采用该编码器能够满足系统要求。2.3步进电机模块的论证分析2.3.1步进电机步进数与螺旋编码盘输出脉冲之间关系由于步进电机步进角为1.8，旋转编码盘分辨率为0.36，可以求得每一个步进 角将对应5个旋转编码器输出脉冲。我们所采用的是步进电机十六细分下的，所以最后 的送给电机的单个步进角对应脉冲数N=5*16.232步

16、进电机最大空载启动频率分析与计算根据自由摆运动模型可知，平板在最低位置处角速度达到最大值，max =128 /S, 为保证系统的可靠，要求步进电机最大启动速度能达到2max =256 /s，由于步进电机 步进角为1.8，因此可以算出空载启动频率f=2max /1.8=142.3Hz，而我们选用的步 进电机空载启动频率远高于该频率，因此我们选用的步进电机能符合系统要求。3电路与程序设计3.1电路的设计3.1.1系统总体框图，如图六所示。图六系统总体框图3.1.1电路原理图见附录132程序的设计3.2.1程序功能描述主程序根据不同的要求设定不同的控制模式，在各个模式间切换。根据设计要求， 我们把程

17、序归为几个模式，由按键切换模式。具体分配如下：模式一对应为基本要求一，即平板跟随自由摆旋转一周误差不超过45；模式二对应为基本要求二和基本要求三，即保持硬币在平板上的平衡，不让硬币掉 落；模式三对应发挥部分一和发挥部分二，对激光笔入射位置的调整以及保持激光笔入 射位置的固定与平衡；3.2.2具体的程序分析设计（1）主程序分析设计主程序流程图如图五所示，主程序由两个按键控制三个模式的选择。当系统启动时， S1按下选择模式一，S2按下选择模式二；若S1和S2都未按下，那么执行模式三。(2)模式一的分析论证 模式一程序流程图，如图八所示。C模式一)是启动定时 器电机钱动因为自由摆的周期是固定的，我们

18、计算为2s 一个周期，所以需要控制电机转动在 2s内旋转360。采用定时器定时，在十六细分下，发每个脉冲的周期为625us。定时器 定时即为625us。3200脉冲电机旋转一周，此时，每旋转一周，记录旋转周数的变量加 一，到五周后，程序执行结束。(3) 模式二的角度测量中断服务判断程序的分析论证模式二的角度测量中断服务判断程序，如图九所示。进入中断程序后，我们需要确定的是左右侧的方向标志。设定两个定时器分别为T1 和T2。T1为左侧的计数器，T2为右侧的计数器。判断当T2大于零而且T1等于零时， 表明平板往右摆，置右摆标志位为一。判断当T1大于零而且T2等于零时，表明平板往 左摆，置左摆标志位

19、为一。对应的计数器加一后，开始查表，找到对应的电机脉冲数， 送给电机，从而控制电机转动。图八 模式二角度测量中断服务程序流程图(4) 模式二程序分析与设计选择模式二后，摆杆缓慢拉到一定的角度，同时单片机获得旋转编码器所送来的脉 冲并记录下来，拉到一定角度后摆杆停止，此时，单片机就获得了最后的角度值。按键开始后，单片机根据获取的角度值，换算为电机的转动脉冲数，发给电机，电10机立即开始转动，保持平板对摆杆的垂直。最后，电机锁定，避免电机的抖动。 此时程序执行结束。模式二的程序流程图，如图九。图九模式二程序流程图（5）模式三的左右侧中断服务判断程序的分析论证与模式二的中断服务程序相同，对左右侧判断

20、是一样的方法。相对于模式三的特殊性， 在获取角度之后，换算为电机的脉冲数，还应该计算此次的脉冲数与前一次的脉冲数的 差值，也就是计算出脉冲数的增量值，是电机转动的是一具增量变化的，这样就能达到 电机的转动是跟随角度脉冲变化的快慢以及大小而跟这变化。达到最终的实时控制，保 持激光笔在靶纸上光斑的位置恒定。选择模式三后，摆杆开始拉动摆杆，单片机内部立即根据旋转编码器的A通道和B 通道的脉冲相位关系，判断出平板摆动位置在中心线的左右侧。判定之后，0 3 （反转 标志位）的值或0 4 （正转标志位）的值对应增加，记录下旋转编码器的脉冲数。再通 过计算，转换为电机的转动脉冲数。如果开始按键S3按下，那么

21、所计算的电机旋转脉冲发给电机，电机立即转动对应 地调整平板位置，使激光笔找着最初入射靶纸上的位置或者是保持靶纸上激光笔的光斑 入位置尽可能保持不变。模式三的程序流程图，如图十一。124测试方案与测试结果4.1测试方案（1）硬件测试采用数字万用表对电路板连接情况测试。（2）软件仿真测试通过信号发生器产生周期方波，单片机最小系统对方波信号计数并显示脉冲数。通 过比较显示信息与数字示波器显示频率比较。（3）系统误差测试系统误差按照系统要求分别测试在一个周期内平板旋转角度、当放一枚硬币时自由 摆在30和45起始位置摆动时，硬币摆动一周初始位置偏离的距离及自由摆在45 和60起始位置摆动时，八枚硬币滑落

22、平板的个数。发挥部分分别测量角度在30 -60之间各角度下，激光笔光线偏离中心线的距离。42测试条件与仪器测试条件：检查多次，仿真电路和硬件电路必须与系统原理图完全相同，并且检查 无误，硬件电路保证无虚焊。单片机显示脉冲数与信号发生器产生相同时间显示脉冲数 相符。测试仪器：量角器、米尺、数字万用表(DT9205)、游标卡尺，铅垂。4.3测试结果及分析(1)多次测量在一个摆动周期内平板转动角度测试方法：在最低点处保持平板水平，将摆杆拉至最高点，启动电机开始转动8圈后停止，同时让单摆自由摆动8个周期后到达最高点时停止，用量角器测出平板偏离水平的角度。测量 次数12345678平板偏 离水平 的角度

23、5263495451595864平均 误差6.57.96.16.86.67.27.2&0误差分析：该测试方法通过多次测量求均值降低了测试时的系统误差，较为准确的测试出了实 验的误差。(2) 1枚硬币滑离中心位置的距离(cm)测试方法：将摆杆推至一个角度(30 -45 )，在水平的平板上放置1枚硬币, 并在白纸上标记其轮廓，启动系统后，观测硬币滑动的距离。次数12345678角度3033353940414345滑动距 离(cm)0.30.30.40.50.60.60.70.8误差分析：由实验测试结果可以看出，当摆杆起始角度由30到45逐渐增大时， 硬币滑离中心位置的距离越大(在实验允许的误差之内

24、)，这符合理论分析的结果且符 合实际生活规律，达到了预期的实验效果(3) 8枚硬币最底层硬币滑离中心位置的距离及硬币跌落数目测试方法：将摆杆推至一个角度(45 -60 )，在水平的平板上放置1枚硬币， 并在白纸上标记其轮廓，启动系统后，观测8枚硬币最底层硬币滑离中心位置的距离及 硬币跌落数目。次数12345678角度4548495253565760滑动距 离(cm)0.30.40.51.20.60.82.81.0跌落数 目00010010误差分析：由实验测试结果可以看出，当摆杆起始角度由45到60逐渐增大时， 最底层硬币滑离中心位置的距离越大，当硬币发生跌落时，相应的最底层硬币滑离中心位置的距

25、离也很大，这一结果符合理论分析的结果。（4）摆杆停留在固定角度（30 -60 ）时激光笔瞄准情况测试方法：在平板上固定激光笔，摆杆停留在固定角度时启动电机，带动平板上的 激光笔转动，激光笔光斑离标记中心线处的距离记录如下：次数12345678角度3034404348515660光斑偏 离量 （cm）1.20.90.70.70.60.60.50.4完成时 间（s）33445556误差分析：由实验测试结果可以看出，当摆杆偏转角度增大时，激光笔距离标记中 心线近，光斑偏离量小，但电机需要旋转的角度大，所需的时间长。（5）摆杆自由摆动时激光笔瞄准情况测试方法：在平板上固定激光笔，将摆杆推至（30 -6

26、0 ）处，使光斑指向标记处, 启动电机并释放摆杆，观测激光笔随摆杆自由摆动过程中光斑偏离标记处的最大距离。次数12345678右侧释 放时起 始角度3032384345505660最大偏 离距离 （cm）1.01.01.31.31.41.51.71.9左侧释 放时起 始角度3035374548525760最大偏 离距离 （cm）1.21.21.31.51.51.61.82.0误差分析：由实验测试结果可以看出，当摆杆偏转角度增大时，对应的光斑偏离标 记中心线增大。且摆杆从左边释放时的误差比从右边同样高度处释放的误差大，因屏在 右边，所以这一实验结果是可以接受的。4.31测试分析与结论根据上述测试

27、数据，由此可以得出以下结论：（1）在一个周期内平板旋转角度误差基本在15以下，完全能满足设计要求。（2）在摆动一个角度硬币偏离中心位置的距离30时误差基本保持在5%以内，在 45时偏离中心位置距离变大，但是也都能满足设计要求。(3) 在放置8枚硬币后摆动一个角度,硬币很少滑落。总体来看，控制系统能够达 到设计要求。(4) 在30到60之间均匀取角度测量激光笔光线与中心线的距离。测量结果偏 距均在要求2cm内。综上所述，本设计基本达到设计要求。5总结此次基于自由摆的平板控制系统设计，以单片机为控制核心，采用1000线增量型 旋转编码器实时采集自由摆旋转角度及方向信息，并通过步进电机开环控制平板旋

28、转角 度，以实现控制要求。达到了在一个周期里电机精确旋转一周；平板角度调整速度快， 8枚硬币滑动小无跌落；实时控制激光笔保持静态水平误差在1cm以内；动态控制误差 在2cm以内的实验效果。总结该设计的实现过程，具有以下三个方面的优点：首先，采用1000线增量型光电旋转编码器，输出信号A、B为高低电平的数字脉冲 信号，可直接与单片机管脚相连，无需额外附加驱动电路，精简了整体硬件电路设计。 实验中可根据光电旋转编码器输出脉冲触发单片机外部中断的快慢，判断摆杆的旋转速 度，根据光电旋转编码器输出脉冲的多少，判断摆杆的旋转角度，根据光电旋转编码器 输出信号A、B的相位关系，判断摆杆的旋转方向。因而该设

29、计方案具有角度值精确度 高，旋转方向判别稳定可靠，硬件电路接口简单的优点。其次，采用高性能步进电机及配套的步进电机驱动器，该步进电机最小步进角为1.8 度，且可对步进电机进行四细分、八细分、十六细分可调控制，进而实现步进电机的微 小精确控制。此外，该步进电机具有较短的响应时间，经理论计算可完全满足平板保持 动态水平的实时性要求。再者，该步进电机驱动器具有脱机功能，可实现步进电机的锁 定，从而使步进电机转动到指定角度后能够稳定保持在这一位置，增强了控制的稳定性。 最后，该步进电机具有较大的带负载能力，保障了在带动平板转动的过程中稳定而可靠。再次，在该设计的程序编写方面，用光电旋转编码器输出信号产

30、生脉冲数，直接计 算出摆杆的角度，再由摆杆角度计算出步进电机需要转动的角度，再由步进电机转动角 度计算出步进电机的步进数，人为的算出光电旋转编码器输出信号脉冲数与步进电机步 进数的对应关系后，建立起两者的关系数组，单片机直接查表即可输出对步进电机的步 进数控制量，极大的减少了单片机进行复杂的三角函数运算的时间，且有效的降低了单 片机进行复杂的三角函数运算的舍入误差，提高了实验的精度。以上三方面的优点是该设计方案得以取得良好的实验结果的有力保障。同时，该设 计方案也存在不足和有待完善之处。如查表法虽提高了运算速度和实验精度，但在程序 修改上比较麻烦和不便。参考文献1 全国大学生电子设计竞赛组委会

31、全国大学生电子设计竞赛获奖作品选编M 北京：北京理工大学出版社，2007.2 刘宝延步进电机及其驱动控制系统M.哈尔滨:哈尔滨工业大学出版社，1972.3 周航慈单片机应用程序设计技术M.北京：北京航空航天大学出版社，1991.4 郁有文传感器原理及工程应用M 西安：西安电子科技大学出版社，20085 吴建平传感器原理及应用 M 北京：机械工业出版社，20096 宋戈.51单片机应用开发范例大全M.北京：人民邮电出版社，2010.7 唐继贤.51单片机工程应用实例M.北京：北京航空航天大学出版社，2009.附录1:电路原理图显示模块电路图GMDVC= H：hiFJcc1F1130pF-Y112

32、1I2,1F1130pF7D4D5D6D8D9DIOD1TD12SIo11IIDI314DI415DI515DI5171s1313P1.0VccPl.lPO.OPl.280C52畀Pl.3F0.2Pl.4P0.3Pl.5P0.4Pl.6P0.5Pl.7P0.6RST/VpdP0.7P3,0.K-：DEA.VppP3.1/TXDALEPROGP3.2HNT0PSENP3.3HNT1P2.7P3.4JT0P2.6P3.5JT1P2.5P3.7 虹P2.3XTAL2P2.2GNDP2.0C240393S-36353-80C523TT211D.745I-4-SHUb c d e f dp議$11313

33、CT2927252421/ccQ3| :JQ4:(z)gp (8=0=!)阴 :0=f !p t jqo pauSisun_ (q q.uin) iu_joq.oni piOA/* ( 44科廡)修料出甲 瑕爭 */ 趣曲SW甲：0=J_IJ:卄 i_3uu_ouI ：0=厂輒广0珂_ (0=q_O2q9a)JI缺餌/ 奎翅糜抽卑餌镌!o=rsu:I=J_3bij ：卄1一鉅叮一0珂 ：0=呢 口一0 珂_ d=q_q99)Ji0 dnjjaui ()unj_ouI PTa/ (母二LL 歸味 */趣鄭馳沁期delay(200);/* 步进电机转动(顺时针)*/ void motor_shun

34、(uint a)unsigned char i,j;j=0；for(i=0;i=8) j=0;delay(2);delay(200);(3)摆角测量程序void angle_cou nt() angle_r=int0_flag_r*0.36; angle_l=int0_flag_l*0.36; if(angle_r0)angle_l=0; angle=angle_r;else if(angle_l0)angle_r=0;angle=angle_l;附录3：主要元器件明细序号名称、型号及规格数量备注1STC89C51最小系统1系统控制2光电编码器E6B2-CWZ6C1旋转角度测量3步进电机42BYG250-481控制平板转动44步进电机驱动ZD-6209-V21驱动步进电机5三端稳压器78051产生5V电压6电阻若干7电容若干