声音引导系统设计-单片机设计论文11

1、目 录 B 甲 072 目目 录录 摘摘要要 .1 1系统方案系统方案 .1 2设计与论证设计与论证 .1 3电路设计电路设计 .1 4系统测试系统测试 .1 5总总 结结 .1 参考文献参考文献 .1 附录附录 .1 1 声音导引系统声音导引系统 摘要摘要 本系统采用直流电机控制的小车作为移动声源，整合 MMC-1 芯片、喇叭、麦 克及无线模块，通过 EasyARM1138 来调控可移动声源达到目的地。 在可移动声源行进过程中，声源发出一定频率的周期音频脉冲信号， EasyARM1138 根据各接收器接收声音的时间差可计算出移动声源的具体位置，然 后通过无线模块把具体的坐标传送到主控制器，主

2、控制器利用双闭环控制原理和 PID 算法分别对线速度和方向进行实时调整，从而使可移动声源成功达到目的地。 本设计采用 32 位单片机做 CPU，运算速度快，结构简单，电机控制快速准确。 该系统经过多次实验验证平均速度达到 11cm/s，误差在 1cm 以内，超调小于 1cm，达到了设计的要求。并且本系统增加了显示小车行驶时间和平均速度等特色 功能。 2 1系统方案系统方案 1.1整体方案比较整体方案比较 为了更好的实现该系统要求的任务，对以下几种方案进行具体的分析和论证。 方案一：从处理器把声音接收器接收到的声音信号通过 A/D 转换，转换成数 字信号，然后把数字信号进行分析处理，根据声音的强

3、弱计算出可移动声源与接收 器之间的距离，把距离信息通过无线装置发给主控制器，通过主控制器进行 PID 运算，计算出角速度控制系数 KW和速度控制系数 KV，根据这两个控制系数控制 左右轮的转速和方向。 方案二：从处理器把声音接收器接收到声音信号的时间差进行处理，计算出可 移动声源的具体位置，把此定位信息通过无线收发装置发给主控制器进行, x y PID 运算，用逐次逼近的方式进行双闭环控制，使可移动声源移动的方向与可移动 声源和目标位置之间连线的夹角趋于零，以此减小超调量，降低误差，另外使可移 动声源与目标位置之间的距离 s 趋近于零，完成任务要求。l 方案一与方案二对比，可以看出方案一采用的

4、 D/A 转换方式处理声音信号难 以实现，因为距离较短，并且还要放大滤波，较为麻烦，此外方案一中对小车速度 和方向采用的是开环控制，误差大，并且不稳定，而方案二中对可移动声源的定位 则利用不同接收器接收声音信号的时间差，由数学运算得到的，这种方法简单，可 靠性高，另外方案二中对小车的控制采用的是双闭环控制，可以使可移动声源高速 稳定的达到目的地。所以本系统采用的是方案二。 1.1.1 主控制器模块选择主控制器模块选择 方案一：采用 89C51 单片机实现。单片机软件编程自由度大，可用编程实现 各种控制算法和逻辑控制，并且晶振频率相对较低，处理复杂算法耗时较长，另外 51 单片机需要仿真器来实现

5、软硬件调试，较为繁琐。 方案二：采用 32 位的 EasyARM1138 单片机实现。此单片机可以工作在 50MHz 的频率下，处理速度快，有三个完全可编程的串口，并且 8 个通用计时器 可以实现定时计数和 PWM 输出，另外本处理器具有 64K 单周期 Flash，多路中断， 同时这款单片机的低功耗、低成本，性价比高。 结合题目的要求以及 EasyARM1138 处理器的特点，本系统选择方案二。 1.1.2 小车电机控制方案小车电机控制方案 方案一：玩具小车上的两个电机均为一般的玩具直流电动机，前轮用一个电机 来控制方向，后轮用另一电机控制速度。 方案二：采用一般的直流电动机，但是采用的是左

6、右轮分开控制的策略，左右 轮分别用一个电机控制。 以上两种方案中，方案一是传统的控制小车方向的方式。但是由于转向太过灵 敏，转向时容易卡死，造成电机烧毁，在方向控制时摆动过大不易精确控制。另外， 在直道区直线行驶时，由于本身结构上的因素，其运动轨迹是个曲线运动。而方案 二种只要送给两个电机的电压相等即可基本上实现直线运动。同时由于此方案中结 构的因素，使得小车校正方向的灵敏度高，适合本题运行稳定、高效和安全的要求， 3 可以实现方向的精确控制，因此选用方案二。 1.1.3 速度控制模块速度控制模块 方案一：使用功率三极管作为功率放大器的输出控制直流电机。线性型驱动的 电路结构和原理简单，成本低

7、，加速能力强，但功率损耗大，特别是低速大转矩运 行时，通过电阻 R 的电流大，发热厉害，损耗大，对于小车的长时间运行不利。 方案二：采用继电器对电机的开或关进行控制，通过开关的切换对小车的速度 进行调整，此方案的优点是电路较为简单，缺点是继电器的响应时间慢，易损坏， 寿命较短，可靠性不高。 方案三：采用由双极性管组成的 H 桥电路。用单片机控制晶体管使之工作在占 空比可调的开关状态，精确调整电机转速。这种电路由于工作在管子的饱和截止模 式下，效率非常高；H 桥电路保证了可以简单地实现转速和方向的控制；电子开关 的速度很快，稳定性也很高，是一种广泛采用的调速技术。 综合三种方案的优缺点，决定选择

8、方案三。 1.1.4 电源模块电源模块 由于小车的耗电量很高，因此电源的好坏直接影响小车的整体性能。如果采用 传统的干电池或蓄电池直接给小车供电，随着电压的降低，相同占空比控制下的电 机转速不同，造成小车不能正常完成全路程，因此通过干电池或蓄电池之后加电压 稳压环节，使得小车在一定时间范围内能够正常运行，通过对各稳压集成块性能的 查询，决定采用 7805 稳压集成芯片。 1.2控制方案控制方案 该系统主要由声音采集处理模块、无线收发模块、控制模块和直流电机构成， 其整体的系统结构框图如图 1-1 所示。 直流电机PWM输出 EasyARM1138 + ASSP 显示模块 无线接收 UART 信

9、号处理 EasyARM1138 声音 接收器 无线发送 UART 信号处理 图图 1-1 系统结构框图系统结构框图 2设计与论证设计与论证 2.1软件设计软件设计 发送部分软件设计，主要进行等待定时器中断，接收到声音信号之后，产生中 断，读出定时数据。通过计算两个接收器中断的时间差来确定声源所在的坐标。然 后，把坐标数据通过无线模块发送到接收端。 4 接收部分软件设计，除了接收坐标数据之外主要进行的是通过坐标对小车的位 置进行定位。为了提高控制精度，利用双闭环 PID 控制，使小车达到目的地。 开始 系统初始化 等待 ？有中断 处理中断 定位声源位置 发送位置坐标 结束 ccc N Y 开始

10、系统初始化 ，声源发出脉冲 电机旋转 ？到达目标 ，PID运算 调整各 电机转速 结束 Y N 图 2-1 程序流程图 2.2误差的产生及分析误差的产生及分析 在实际测量过程中，测量值与实际值存在一定误差，主要原因如下： 1)由于声速与测试环境（温度，噪声）差异，测量值也会产生误差。 2)由于声音传播时间太短（小于 5ms） ，声音采集量化环节对测量精度要求 很高，电路延迟或其它原因会直接影响到测量数据的采集。 3)由于声源占据一定空间，并且多数情况下声源与小车标定线并不在相同的 位置上，测量值并不是实际需求值，二者存在几何对应关系。 综上所述，由于直接测量数据的不可靠性，需要对其进行优化校正

11、。修正硬件 装配误差后，通过多次测量多个已知点坐标，将测量值与实际值比较，对测量系数 在一定范围内进行蒙特卡洛优化，求得最优转化系数。 2.3声源定位算法声源定位算法 可移动声源与接收器的具体位置如图 2-2 所示。 5 (0,0) Y X (100,0) (0,100) (100,100) 接收器C 接收器A 接收器B W S(XS,YS) P Q L1 L2 L3 O D x yO, 图 2-2 令， 分别为 S 点到 C，A，B 三点的距离，分别为声 1 L 2 L 3 L 1 T 2 T 3 T 音到达 C，A，B 三点的计时时刻，为声速，因此可得： 0 v 2 22 1 222 2

12、2 22 3 1 1 SS SS SS LXX LXY LXy 又因为： ，； 1201201 LLVTTVT 2302302 LLVTTVT 所以 ； 2 222 01 1 SSSS VTXYXY 。 2 222 02 1 SSSS VTXYXY 通过解方程组获取（）的可行解，既是可移动声源的具体位置坐标。, SS XY 2.4距离与夹角控制算法距离与夹角控制算法 为了对可移动声源的速度和运行方向进行精确的控制，首先需要求出距离目标 的距离和当前位置与目标位置的夹角。 设起始位置，当前位置，目标位置，则距离误差：(X) BB ,Y(X) SS ,Y(X) DD ,Y 22 ()() DSDS

13、 LXXYY 当前位置和目标位置的夹角为 1 1 arctgarctg DSKK DSKK YYYY XXXX 6 其中，和分别为声源的两次采样位置； 11 (X) KK ,Y (X) KK ,Y 为小车自身校正角度。 1 1 arctg KK KK YY XX 2.5PID 控制算法控制算法 系统对可移动声源的控制采用的是 PID 控制，此控制方法简单，且稳定性高。 PID 控制算式采用增量式算法，辅以限幅和积分算法。 ()()(1)(2)U KAe KBe KCe K 其中，0 000 ,2, cDcDcD ccIc K KK KK K AKK KTBKC TTT others E)k(

14、e,0 max I I K K ( )(1)()u kU KU K max max (),() () others u Ku KU U K U ， 其中为比例系数、为积分系数、为微分系数、采样周期 c K I K D K 0 T （2550ms） 、为积分误差限（设定 10cm） 、为电机的最大控制电压。 max E max U 3电路设计电路设计 本节给出声音信号的接收与处理两个主要模块的电路设计方案。 3.1MIC 信号处理电路信号处理电路 主要对接收到的声音信号进行滤波、放大等处理。 MK1 MIC R1 2K R2 47K R3 1K R4 47K R9 1K R8 1K R10 47

15、K R6 4.7K R7 47K R6 47K R5 1K C3 0.01uF C3 0.01uF C2 0.01uF C1 0.01uF C2 0.1uF 1 2 3 J1 CON3 VCC LM324_1 LM324_2 VCC C4 10uF 图 3-1 MIC 处理电路 7 4系统测试系统测试 1)小车能完成基本部分功能，通过控制达到目的地，能停止一段时间进行声 光报警。 2)小车能完成发挥部分功能，达到目的地并且定位误差小于 1cm。 3)具有显示模块，可以显示整个过程所用的时间。 测试数据请见表 4-1。 表 4-1 系统测试数据 待测数据数据 响应时间4.3s 平均速度11.6c

16、m/s 定位误差1cm 5总总 结结 本设计采用 32 位单片机做 CPU，运算速度快，结构简单，电机控制快速准确。 该系统经过多次实验验证平均速度达到 17cm/s，误差在 1cm 以内，超调小于 2cm，达到了设计的要求。并且本系统增加了显示小车行驶时间和平均速度等特色 功能。 参考文献参考文献 1 刘金琨先进 PID 控制及其 MATLAB 仿真北京：电子工业出版社，2003 2 康光华，邹寿彬电子技术基础（模拟部分） 北京：高等教育出版社，1998 3 刘寿松自动控制原理第三版北京：国防工业出版社，1994 4 吴麒自动控制原理北京：清华大学出版社，1990 5 陈炳和计算机控制系统基础北京：北京航空航天大学出版社，2001 8 附录附录 1、扬声器驱动电路 LS1 SPEAKER R1 10 R2 10KC1 0.05uF C2 220uF 1 2 3 J1 CON3 2 3 4 5 6 Q1 LM386 VCC 附图 1 扬声器驱动电路 2、比较器电路 R3 4.7K R4 47K R5 47K R2 4.7K 1 2 3