【《配送机器人声音导航系统设计案例》5700字】_第1页
【《配送机器人声音导航系统设计案例》5700字】_第2页
【《配送机器人声音导航系统设计案例》5700字】_第3页
【《配送机器人声音导航系统设计案例》5700字】_第4页
【《配送机器人声音导航系统设计案例》5700字】_第5页
已阅读5页,还剩6页未读, 继续免费阅读

付费下载

下载本文档

版权说明:本文档由用户提供并上传,收益归属内容提供方,若内容存在侵权,请进行举报或认领

文档简介

配送机器人声音导航系统设计案例目录TOC\o"1-3"\h\u6117配送机器人声音导航系统设计案例 I174451声源的硬件检测系统设计 I83931.1声源定位系统总体结构 I189821.2麦克风阵列设计 II9697(1)麦克风数量 II2600(2)麦克风间距 II14877(3)麦克风参数与性能 II26401.3惯性导航模块 III22072(1)JY901B模块实物 III26347(2)JY901B模块参数 III65911.4单片机电路设计 IV194291.5LC12S数据传输模块 V105611.6液晶显示电路设计 VI314132机器人的运动模型建立 VII150822.1坐标系的建立 VII186982.2驱动轮的运动学分析与轮式全向移动机器人的运动学模型 VII115492.2.1驱动轮的运动学分析 VII95952.2.2轮式全向移动机器人的运动学模型 VIII78862.2.3移动性能分析和讨论 X1声源的硬件检测系统设计1.1声源定位系统总体结构系统的硬件模块以惯性导航模块为主、麦克风阵列信号采集模块,处理单元STM32、所述无线数据收发模块、OLED显示模块以及Arduino核心控制模块等6个部分。首先,该系统通过自行设计的麦克风阵列对声源产生的声音信号进行收集,声音信号经放大,A/D转换之后,由无线传输模块LC12S将其发送至STM32进行处理,STM32与Arduinomega2560处理器进行串口通信,结合惯性导航模块JY901B获取的位移数据,对其进行了统一计算,得到了最终成果,最后,在OLED中显示声源二维坐标方位。以惯性模块为核心的机器人声源定位系统总体设计方案,如图1.1中所示:图1.1系统整体方案图1.2麦克风阵列设计该设计以麦克风阵列为核心,搭建了机器人听觉系统,完成了声源定位功能。麦克风阵列获取声音信号是该设计中最关键的环节,是否能准确地获取声音信号,会直接关系到后续定位效果。(1)麦克风数量麦克风阵列内麦克风个数对系统性能具有决定性影响,实际设计时,既考虑了系统需要,还必须与成本相结合、实现难易程度及其他因素。如果麦克风的数目较小,所收集的资料越少,造成系统精确度的不足;如果麦克风太多,再提高系统运算量,达到的代价太高。本论文基于对阵列信号处理的相关技术进行研究,选取三个驻极体麦克风,分别设置于正方形三个顶点处,负责声音信号的收集,在满足需要的情况下,系统实施的费用并不高、运算量较小时,尽可能地收集比较准确的数据。(2)麦克风间距该系统声源定位功能以六足移动机器人为原型,麦克风阵列需安装到移动机器人,而且移动机器人本身体积也很小,所以麦克风阵列也要设计得比较小巧。经实际测定,最后将麦克风阵列的间距设置为50厘米。(3)麦克风参数与性能该系统选择了驻极体麦克风构成阵列,驻极体麦克风的普通工作电压是3V,工作电流在0.1~1mA,这种驻极体麦克风的接收频率在100Hz到10KHz之间,最大采集范围可达到5米,固有噪声较低[39]。该麦克风模块具有灵敏度高的特点,内置放大电路增益可调节,模块有AO(模拟量输出)和DO(数字量输出)2个输出,感应声音强度可由50K电位器来调整(逆时针加强,顺时针削弱)它的AD转换功能可将声强和电压转换,它的电路图见图1.2:图1.2麦克风模块电路图1.3惯性导航模块(1)JY901B模块实物JY901B模块,X、Y和Z三个坐标轴满足右手定理且Z轴是垂直向外。JY901B模块的引脚说明如表1.1所示:名称功能VCC模块电源,1.3V或5V输入RX串行数据输入,TTL电平TX穿行数据输出,TTL电平GND地线SCLIIC时钟线SDAIIC数据线D0扩展端口0D1扩展端口1D2扩展端口2D3扩展端口3(2)JY901B模块参数该系统选择了高精度惯性导航模块JY901B来采集机器人运动时加速度,角速度等数据,模块尺寸较小,易于与机器人平台固定连接,并在模块内使用姿态解算及动态卡尔曼滤波算法进行求解,采集数据的精度可达0.01°已达到专业器件级别,JY901B模块参数见表1.2:参数说明电压3V~6V电流<40mA体积15.24mmX15.24mmX2mm测量维度加速度:3维,角速度:3维,磁场:3维,角度:3维,气压:1维量程加速度:±16g,角速度:±2000°/s分辨率加速度:6.1e-5g,角速度:7.6e-3°/s。稳定性加速度:0.01g,角速度0.05°/s。数据输出频率0.1Hz~200Hz数据接口串口(TTL电平,波特率支持2400、4800、9600、19200、38400、57600、115200、230400、460800、921600),IIC(最大支持高速IIC速率400K)1.4单片机电路设计STM32是从意法半导体公司引进的一种高性能微处理器,在这些处理器中,以ARM-M体系结构Cortex-M3为代表。属32位标准处理器RISC架构,含有高效,灵活Thumb-2指令集;Cortex-M3具有功耗小,门数少等特点、中断延迟较短,调试成本低。另外,意法半导体公司还发布了与之匹配的开发软件,提供相关官方固件,使大批开发者投身STM32研究与开发,STM32系列处理器问世,以其低价,高性能,很快占领市场,得到了众多开发者及企业的欢迎。STM32F103x系列增强处理器,工作温度范围最低为-40°C,最高可达到+105°C,供电电压为1.0V~1.6V,实现了非工作状态省电模式的自动切换,减少了功耗,在多种工业场合中得到了广泛使用。STM32F103x系列处理器包含LQFP36、LQFP48、LQFP64、LQFP100、LQFP144等4种不同封装方式,在内部配置上也存在着一些不同。STM32F103RBT6微控制器使用的是Cortex-M3内核结构,该设计使用了LQFP144进行封装,它有着大量片上外设,表现突出[40]。其内主频72MHz,闪存128KB,RAM为20KB。片上外置USB1.0全速接口和CAN接口、十六位定时器、USART接口、七通道DMA控制器,16通道12位A/D转换器,等等。STM32F103RBT6具有48个快速多功能双向I/O端口,所有的I/O口都能映像为16个外部中断;每一个I/O管脚可被软件配置为输出(摊拉或开路)、输入(拿着或者没拿着就拉倒或者下来)或者其他外设功能口;大多数I/O管脚是由数字或者模拟外设所共享,全部I/O管脚均具有大电流通过能力。该设计主要使用了片内AD转换器模块,RTC实时时钟、UASRT模块的特点等等。其中,AD转换器,用于对麦克阵列的处理信号进行采集,利用RTC时钟对数据进行时间标记。最小系统由8M外部晶振电路,31.768KHz时钟晶振和复位电路组成、JTAG仿真接口和启动模式设置。STM32的内部电路见图1.3:图1.3STM32内部电路1.5LC12S数据传输模块本课题选择的数据传输模块是LC12S无线传输模块,由于麦克风阵列的设计间距太大,麦克风阵列内每个麦克风所收集的声音信息需通过该模块传输给STM32处理器处理。模块使用了最新的1.4GSOC技术,实现了串口透明传输,该模块不受数据包大小的限制,延时较短,在数据采集,智能家居等领域得到了广泛的应用、AGV机器人等等方面。LC12S中数据传输模块的引脚见表1.3:表1.3LC12S模块参数引脚引脚名称引脚功能描述1VCC电源电源(接1.2~1.6V)典型1.3V2RXT模块数据输出(TTL电平)串口通信数据接收3TXD模块数据输入(TTL电平)串口通信数据发送4SET设置位配置参数使能5CS休眠接低电平时工作,悬空时为高电平6GND电源接地上电后在CS引脚接通低电平的情况下运行,SET脚就是设定参数的标志位,拉低或者短接在地面上,可以在低电平的情况下,把模块转换为参数配置的模块式引脚来设定,当TXD与RXD的引脚接通高电平后,即进入运行状态。1.6液晶显示电路设计现有液晶屏包括TFT液晶,LCD液晶,IPS液晶等、OLED液晶和AMOLED液晶,如TFT液晶、LCD液晶和IPS液晶在色彩上有着更加艳丽的优点,但是,与此同时,它所带来的耗电量也是比较大的;OLED与AMOLED抛弃传统背光驱动方式,利用LED发光材料实现直接显示,当它呈现出纯黑色的时候,耗电量接近于0,毫无疑问,这对移动设备来说是一件幸事。该系统使用0.96寸单色OLED模块显示数据,显示设备功耗减小,然后搭配程序待机和唤醒模式,有效地解决移动设备低功耗的问题0.96寸单色OLED模块嵌入SSD1306驱动芯片,引出6针的SPI/I2C通信接口,该设计利用I2C协议和单片机交换数据,使用1.3V电源。0.96寸OLED模块的每个引脚的功能进入到表1.4中:表2.4模块功能引脚图引脚方向功能描述GND接地线VCC液晶模块电源正电压输入(2.3V)SCL输入串行时钟引脚SDA输入串行数据引脚RES输入复位引脚D/C输入数据/命令选择引脚2机器人的运动模型建立2.1坐标系的建立导出机器人整体运动模型,要求由低级至高级逐一进行,其中包括机器人位姿表示,单车轮运动学表示等,若干个轮子结合起来,共同完成机器人整体移动的限制。与机械手臂固定不动相比,移动机器人因其独立性,移动性等特性,引入位姿表示这一环节,需建立全局与局部两大坐标系,综合描述移动机器人。运动机器人的工作空间为-一个平面,建立与该平面固连的全局坐标系XIOIRI及与机器人固连的局部坐标系XrOrYr,O为全向移动机器人之质心。由于假定移动机器人的结构是刚性的,侧向运动可以忽略不计。文中所建移动机器人运动学模型具有11个自由度,移动机器人的主体具有横向和纵向、转动3个自由度,每只轮子都有旋转及旋转自由度。在二位平面内,机器人位姿可由一个三维向量(x,y,0)T来表示。以确定机器人在平面内的位姿,这就需要在两个坐标系之间建立-一个映射关系,利用正交矩阵R(θ)来完成全局坐标系向局部坐标系映射:将移动机器人在全局坐标系中的运动映射到局部坐标系中:2.2驱动轮的运动学分析与轮式全向移动机器人的运动学模型2.2.1驱动轮的运动学分析对轮式移动机器人进行运动学分析,首先是要对加到单独轮子上面的约束条件进行表达。轮式移动机器人有4种轮子,即标准轮、全向轮(瑞典轮),球形。轮,小脚轮。全向移动机器人运动学模型是建立在对各个轮子的表达之上的。上面的限制,然后就可结合在一起,算出机器人整体的动作。约束分析前,假设轮子平面始终保持竖直,且轮子和地面之间总是单点接触。本论文所设计之轮毂驱动电机,可视为可操控之标准轮,与固定式标准轮相比,增加了绕垂直轴的旋转自由度。转向过程中转向电机带动轮毂电机围绕竖直的转动轴旋转,与底盘间构成一个连续变化角度β。图2.4是可操纵标准轮A位置姿态的描述,A的方位以极坐标l、α为单位。图2.4可操纵标准轮及参数轮子上的滚动约束强迫沿轮子平面方向上的一切移动产生适度的转动运动,因此接触处滚动约束是:用项将处在全局坐标系中的它变换到局部坐标系内的运动参数,由于方程中有l个参数,故方程是必需的、α与β均以局部坐标系为基础。向量φ三个元素代表沿轮子平面移动到x、y、θ之间的映射。轮子的滑动约束使与轮子平面正交的全部运动分量等于零:以上两式给出驱动轮在移动机器人上运动学作用,改变操纵角β会影响整体移动性。通过上面的分析,我们就会发现,轮子有许多变化范围很广的运动学参数,因此,导出的运动学公式,也就是约束集合,可集成在一起,用于计算机器人整体的动作。文中所采用的驱动轮运动学约束较小,这样减少控制程序复杂度,同时减少自由度。2.2.2轮式全向移动机器人的运动学模型经上述分析,给定全向移动机器人,有4个可操纵轮,可对底盘运动学约束进行计算。其关键在于恰当结合所有轮子所产生的所有运动学约束。特殊之处在于全向轮未对底盘增加运动学之限制,其原因是内部轮子自由度大,移动机器人在各种场合都可以自由设置姿态。本论文所设计之全向移动机器人具有四个可操控之标准轮,因此,四个轮子滚动约束,也就是第一式,可汇集为矩阵表达式:其中,对角矩阵为J2,其数值为每个轮子半径r;J1(β)表示每个约束沿其轮子平面投影得到的运动约束,它是4X3矩阵。由于可操纵标准轮的方向不是固定的,因此,J1(β)就是一个随时间而改变的矩阵。式中矩阵取代上述式子的个别数值,所以,所有的轮子都要考虑在内,因此,公式表示所有标准轮沿轮子平面运动,根据它们的运动规律,绕着各自水平轴转动一定的角度,那么地面接触点将发生滚动运动。类似地移动机器人滑动约束也可通过相同方法获得:滑动约束C1(β)为4X3矩阵,其数值为式(2.5)的3个条目。移动机器人的滚动约束和滑动约束J1(β)和C1(β),及与转速φ相关的可得:先确定了每一轮α,β为随时间的函数。假设车轮位姿调节一定的角度即可得到:在本文设计的移动机器人中:实际应用时,把运动参数引入上述两式:可获得8个方程组,结合其中任三个方程,可求得机器人运动学方程εl。2.2.3移动性能分析和讨论就工业制造而言,机器人学已获得很大成功。在装配线上,将机械手臂固定不动地安装到指定地点,能够高速、高精度地执行任务。但这种机器人有一个基本缺陷,那就是机动性不足。移动机器人具有机动性,即随时在地面上沿任意方向移动。机器人可操纵总自由度,叫做机动程度δM。机动性是由轮子的转速与机器人的直接操作自由度共同组成。固定机械手移动幅度有限,自动导引运输车AGV、火星车等等,令人瞩目的是其机动性。移动机器人能够灵活行走,特别适用于轮式移动机器人,轮子类型选择,装配位置等因素影响了机器人三个主要特点:机动性、可控性与稳定性。(1)机动性就移动机器人的研究而言,能够实现高机动性的其他种类移动机器人非常常见,例如,两轮差动传动机器人,两个轮子围绕中心点旋转,不会发生位置变化,与全向机构机器人相比,该机器人机动性稍差一点。本论文设计了一种全向移动机器人,也就是随时可沿平面沿任一方向移动。为了实现这一机动性,要求轮子至少能在两个方向上移动,底盘方案釆用了一只麦克纳姆轮,能独立旋转平移,无限制。本论文设计之个电机组成之底盘,以控制之复杂性,补偿机械之低机动性,若不计转向限位开关的影响,轮子能灵活°无限准确旋转,它很好地保证了机动性和全向运动。(2)可控性移动机器人可控

温馨提示

  • 1. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
  • 2. 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
  • 3. 本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
  • 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
  • 5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
  • 6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
  • 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。

评论

0/150

提交评论