智能声音跟随玩具小车.docx
智能声音跟随玩具小车智能声音跟随玩具小车 摘要 本设计以TI公司超低功耗 MCU MSP430处理器为核心设计，制作一个可以通过声音跟随人走动且能绕过小型障碍的智能玩具小车。该智能小车要求能够快速定位声源位置并快速反映调整车头行进到声源处，通过应用红外发射、红外接收和声音采集装置与单片机MSP430强大功能及其外围电路连接，再通过电机控制和算法控制来寻找声源及绕过障碍的方法来实现所需功能。 1. 引言 本系统设计在当今遥控玩具汽车盛行的背景下，考虑到遥控汽车的遥控器容易坏，而且一些年龄较少的儿童不会使用遥控器，因此希望做出简单的能进行声源跟随并且能利用声音进行简单控制的玩具小车，以此代替遥控汽车面向年龄更小的儿童。 2. 系统方案 本设计将系统分为五个模块，分别为电源供电模块，430MCU控制模块，避障模块，声源定位模块和驱动模块。通过MCU的引脚对声源定位模块的信号进行扫描，通过算法计算判断声源位置，通过MCU引脚驱动直流电机驱动芯片使小车进行拐弯行进，同时MCU又对避障模块进行扫描，当前方遇到障碍使，MCU引脚电平将发生改变，此时再通过MCU控制驱动电路进行避障。 电源模块关键点：将提供的电源电压控制为3.3V。 避障模块关键点：将红外发生器和接收器放在小车最前端实现前端避障。 声源定位模块关键点：将声音接受器即MIC成三角排列，可通过接受声音的先后顺序，通过算法判断声源位置。 图1：系统方案结构图 3. 系统硬件设计 1） 电源模块 电源模块利用4块1.5V干电池进行供电，利用稳压芯片AMS1117-3.3将电压转换为3.3V,用其对接下来的控制模块，声源定位模块和避障模块进行供电 图2：电源供电模块原理图 2）430MCU控制模块 设计用大赛提供是MSP430G2板作为控制模块，利用VCC和GND进行供电，其中P1.0和P1.1通过电机驱动模块作为左轮的驱动，P1.2和P1.3通过电机驱动模块作为左轮的驱动，P1.4是红外接收结果的反馈引脚，P1.5，P1.6和P1.5是声音接收的引脚。 3)红外避障模块 图3：红外避障模块 红外避障模块由一个红外发射头和一个红外接收头如图构成，将其放在小车的最前端。在小车行进过程中，如果前方有障碍物，由红外发射头发射的红外线将被反射给红外接收头，此时P1.4引脚将被外部下拉为低电平。此则说明前方有障碍物需要绕行。 4）声音定位模块 1车头 MIC1对应P1.5 MIC3对应P1.7 车尾 图4：声音定位模块单个接收器硬件设计电路图 图5：MIC的分布图 声音定位模块由三个如图4的分立电路构成，分别与P1.5，P1.6和P1.7连接，其中每个声音接收器由S8050接成如图4的音频放大电路，用10uf的电解电容进行直流隔离，当MIC输入声音时，MIC的两端电压将产生波动。由Re=0，所以音频放大电路上发射极电阻接近为0，在此计算交流放大倍数应该为，所以只要相应的MIC接收到声音，相应的引脚就会被置高电平，如果没有接收到信号则是低电平。 如图5是三个声音接收器的放置位置，MIC1和MIC3前后间隔6cm，MIC2距离MIC1和MIC2的连接线为4cm。通过对P1.5，P1.6和P1.7的引脚扫描，得到三个MIC接收声音的先后顺序，和相差的时间间隔，以车头为12点钟方向，通过算法算出声源的位置。 5）电机驱动模块 电机驱动通过P1.0， P1.1，P1.2和P1.3利用 直流电机驱动芯片 LG9110来驱动左直流 电机和右直流电机，通 过电机的正传和反转来 完成小车的前进，后退， 左转，右转，从而进行 避障和跟随声音行进。 图6：电机驱动模块 4. 系统软件设计 1） 避障软件设计 小车行进 3cm 扫描前方是否有障碍物 a 53° 否 车头 b 4cm 是 进行避障 3cm c 车尾 2） 声源定位软件设计 一、 算法 如右大图为a、b和c三点为三个MIC的对应位置，各声源位置 个MIC之间距离参数为如图所示，声速为v。 可将三个MIC接收到声音的情况分为6种。 声源在车的左方，a第一个收到声音，b第二个收到声音，c第三收到声音 =arcos(vT1+vT2)/0.06) vT1 声源在车的左方，a第一声个收到声音，c第二个收vT2 1 到声音，b第三收到声音 源 vT1 位1=arccos(vT1/0.06) vT2 vT2 置 声源在车的左方，c第一2 vT1 个收到声音，a第二个收声源位置 声源位置 到声音，b第三收到声音 4 vT2 2=arccos(vT1 /0.06) +90° vT1 声源在车的左方，c第一个收到声vT1 3 音，b第二个 vT2 收到声音，a第三收到声音 3=180°- arccos(vT1+vT2)/0.06) 声源位置 声vT2 声源在车的右方，a第一个收到声5 6 源音，b第二个收到声音，c第三收到声vT1 声位音 源 置 4=37°- arcsin(vT1/0.05) vT1 位0.05 vT2 声源在车的右方，b第一个收到声音，vT2 置 a第二个收到声音，c第三收到声音 0.05 vT1 7 声源 位置 5=90°- =37°+ arcsin(vT1/0.05) 声源在车的右方，b第一个收到声音，c第二个收到声音，a第三收到声音 5=90°+ =143°+ arcsin(vT1/0.05) 声源在车的右方，c第一个收到声音，b第二个收到声音，a第三收到声音 7=180°- arcsin(vT1/0.05) 二、 声源定位程序流程图 小车行进 扫描P1.5是否高电平且a=1 否 扫描P1.6是否高电平且b=1 否 扫描P1.7是否高电平且c=1 否 是 i= i+ S1=i a=0 i = i+ S2=i b=0 是 i= i+ S3=i c=0 是 i是否为1 否 i是否为3 否 i =0;a=1; b=1;c=1; 是 开始计时 是 结束计时 是 结束计时,i=0 记录时间T1 记录时间T2 判断a,b,c的时序，通过T1和T2依照算法计算声源方位 控制电机使小车转向，并往声源位置行进 T1=0；T2=0；S1=0；S2=0;S3=0;a=0; b=0;c=0; 3） 整体系统软件设计 5. 系统创新 系统利用TI公司的超低功耗MCU MSP430从根本上降低了功耗，利用简单的多个共射放大电路，通过引脚扫描和算法运算实现对声源的定位，甚至可以利用声音的时序实现简单的智能控制。而且小车前方具有避障装置，令小车跟随声源的同时具有避障的功能。 6. 评测与结论 系统测试方法： 系统通过多方面的实际使用来测试小车能实现的数据，通过测试10秒内行进的直线距离测试小车的行驶速度，通过多次前方放置障碍测试小车避障情况，通过多次多方位的拍手测试小车对声源定位的成功率。 达到的指标： 速度： 10s行进距离 避障成功率： 成功 43次 声源定位成功率 成功 67次 失败 33 成功率 67% 失败 7次 成功率 86% 第一次 2.8m 第二次 3.1m 第三次 2.6m 第四次 3.3m 平均速度 0.29m/s
