《清洁机器人控制系统的设计.docx》由会员分享,可在线阅读,更多相关《清洁机器人控制系统的设计.docx(6页珍藏版)》请在taowenge.com淘文阁网|工程机械CAD图纸|机械工程制图|CAD装配图下载|SolidWorks_CaTia_CAD_UG_PROE_设计图分享下载上搜索。
1、清洁机器人掌握系统的设计引言随着人口的老龄化和社会福利制度的完善,导致劳动力本钱的急剧上升,一些简洁的重复性的体力劳动为效劳机器人供给了宽阔的市场。清洁机器人是效劳机器人的一种,可以代替人进展清扫房间、车间、墙壁等。提出一种应用于室内的移动清洁机器人的设计方案。其具有有用价值。室内清洁机器人的主要任务是能够代替人进展清扫工作,因此需要有肯定的智能。清洁机器人应当具备以下力量: 能够自我导航,检测出墙壁,房间内的障碍物并且能够避开;能够走遍房间的大局部空间,可以检测出电池的电量并且能够自主返回充电,同时要求外形比较紧凑,运行稳定,噪音小;要具有人性化的接口,便于操作和掌握。结合清洁机器人主要功能
2、探讨其掌握系统的硬件设计。1 测控系统及功能为了使清洁机器人运动更加流畅,防止消灭卡死的现象,把清洁机器人外观设计成扁圆柱形的,扁圆形的设计可以使其自由进入沙发、床和家具底下,把一些边角都能够清扫干净。与地面平行的圆形底盘由三个轮子共同支撑,左右两侧的为驱动轮,分别由两个微型直流电机直接驱动,前面的支撑轮为万向轮。机器人的这种外形和车轮布局可使其便利地实现原地转弯,大大提高了行走的灵活性,这在空间范围较小的地方更为突出。承受碰撞、超声波和红外传感器组成多传感器系统,在机器人的上方装有红外接收装置;在机器人的底部边缘每隔 45装有接近传感器,用来检测台阶,防止跌落;在机器人的前方装有碰撞传感器,
3、前方和左右装有超声波传感器,用来检测四周环境。机器人上装有电源治理系统, 假设电压过低会停顿清扫,并且去自动充电。1.1 微掌握器传统的微处理器如 51 系列虽然开发周期短,本钱低,但其实时性不好,难以实现简单的掌握算法;另外,增加的外围电路数据转换速度慢,使机器人的性能得不到充分的发挥。高速 DSP 的消灭虽然使得系统模块化和全数字化,但其开发本钱高。与 DSP 具有同等性能的 ARM 微处理器资源丰富,具有很好的通用性,其主要技术优点是高性能,低价格,低功耗,广泛地应用于各个领域,因此将 ARM 应用于机器人掌握系统不失为一种好的策略。LPC2210 是飞利浦带有一个支持实时仿真和跟踪的
4、ARM7TDMI-S 微处理器,其承受 3 级流水线技术,能够并行处理指令。由于具有格外小的尺寸和极低的功耗,多个 32 位定时器、PWM 输出和 32 个 GPIO 使它特别适用于工业掌握和小型机器人系统,满足了机器人对掌握器运算速度的要求。以 LPC2210 为核心。设计构造简洁,性能稳定的清洁机器人车体系统。机器人掌握系统主要完成的任务:接收传感器和编码器传来的数据,综合处理进展清扫路径规划;驱动左右轮前进展走,掌握清扫、吸尘机构,完成各种底层掌握动作;设计适宜的人机接口,在 LCD 上显示机器人状态和运行时间。因此,机器人掌握系统包括传感器模块,电机驱动模块这一款超声波传感器有以下优点
5、:适应各种环境,不受灰尘和光线的影响;盲区为 25cm。可以把传感器安装在适宜的位置就可以避开盲区;探测发散角度为15,反响距离 25m 以内,该课题的检测距离为 05m。超声波传感器的根本原理是测量从声波放射和回到接收器所用的时间。这一款传感器的的放射端口和接收端口是一个管脚,首先由掌握器放射一个 5 s 宽度的高电平脉冲来激发传感器放射 40kHz 的超声波,脉冲发出 750 s 后,管脚电平置高;当传感器接收到回波时,管脚的电平被拉低。由信号端高电平的宽度就可以知道由放射到返回需要的时间,宽度为 115 s185ms 之间。公式 svt2,其中 s 表示传感器与目标的距离;t 表示放射到
6、回收的时间;v 是声波速度,v=340ms。由此可以知道传感器与障碍物之间的距离。一次探测时间最多是 20ms,5 个传感器查询完毕,用时l00ms,因此两个相邻传感器承受分时段进展使能,就会避开相互干扰,而不会影响机器人速度。1.2.2 红外接近传感器反射式光电开关是由红外 LED 光源和光敏二极管或光敏晶体管等光敏元件组成, 当有障碍物阻拦时间线能够反射回来,输出为低电平信号;当没有障碍物阻拦时, 光线不能反射回来,输出为高电平信号。清洁机器人的近距离红外接近传感器由两组一样的红外放射、接收电路组成。每一组电路可分为高频脉冲信号产生、红外放射调整与掌握、红外放射驱动、红外接收等几个局部。通
7、过 38kHz 晶振和非门电路得到一个 38kHz 的调制脉冲信号; 利用三极管驱动红外放射管(TSAL6200)的放射。放射管发出的红外光经物体反射后被红外接收模块接收。通过接收头(HS0038B)内部自带的集成电路处理后返回一个数字信号,输入到微掌握器的 IO 口,如图 3 所示。接收头假设接收到 38kHz 的红外脉冲就会返回输出低电平,否则就会输出高电平。通过对 I0 口的检测, 便可以推断物体的有无。1.2.3 碰撞开关传感器两个槽型对射光电开关均布在机器人左前和右前办。如此的布局可以使机器人感知来自前方、左前、右前三个方向的障碍物,从而依据障碍物方向的不同做出不同的反响。当机器人遇
8、到障碍物时,弹簧在障碍物的作用下,向内压迫碰撞开关摆臂,促使簧片挡住光电开关的光线,输出低电平。当没有障碍物作用时,簧片在弹簧的作用下恢复,光电开关的光线没有被遮挡,输出高电平,如图 4 所示。这三个传感器中,超声波传感器用来探测前方和左右的墙壁、障碍。左边和右边的两个超声波传感器垂直于行走方向放置,用于机器人的沿边行走规划;设定机器人行走时与墙边的距离值,调整机器人的行走方向,使两个超声波与墙边的距离近似等于设定值,保持机器人沿墙行走时保持适当的距离,不会撞到或者远离墙壁。前方两个碰撞传感器和一个超声波协作用来用来探测前半局部的环境;接触传感器具有检测范围大、信号无需调理、占用资源少的优点,
9、通过接触碰撞, 检测那些未能被超声波传感器检测到的杆状障碍比方家具腿等,传感器之间的位置如图 5 所示。接近传感器用来探测地面是否有陡崖,在机器人底部的正前、左前、右前和前方各布置 1 个。除了上述三种传感器以外,在三个轮子上都装有一个常开的开关传感器,当轮子悬空的时候,开关就会闭合,输出低电平。当轮子悬空时可以让机器人停顿运转。2 电机掌握系统在小功率系统中,直流电机线性特性良好,掌握性能优越,适合于点位和速度掌握。为了实现直流电机的正反转运行,只需要转变电机电源电压的极性。电压极性的变化和运行时间的长短可以由处理器实现,而供给直流电机正常运行的电流则需要驱动电路。H 桥式驱动电路是比较常用
10、的驱动电路。该设计两个行走驱动电机承受分立器件功率场效应管和续流二极管搭建,本钱低,便于散热,如图 6 所示。用 ARM7 的 P08 和 P09 来掌握电机,这两个管脚都是 PWM 输出管脚,可以掌握电机的速度。该局部主要保证机器人能够在平面内移动,同时轮上带有编码器, 可以对行走的路程进展检测。通过航位推算可以实现机器人的转弯,假设机器人光电码盘的分度数为 N;掌握器收到的脉冲数为 m;轮子的直径为 D;两个轮子之间的间距为 W,则轮子前进的距离为:设机器人在环境坐标系中的位姿为(X(t),Y(t), (t),则第 n+1 次采样的方位角 n+1 值和第 n 次采样的 值有以下关系:式中:vR(t)和 vL(t)分别是在 t 时刻两轮的速度;SLn 和SRn 为两个主动轮从第 n 次采样时刻到第 n+1 次采样时刻之间所行走的距离。假设规定要进展原地转弯,就是一个轮子正转,另外一个轮子反转的方式那么:3 结语清洁机器人作为效劳机器人的一种,有着巨大的市场潜力和宽阔的应用前景。随着传感技术的进展和微处理器的不断进步,价格也在不断下降。在此争论和设计一个基于 ARM7 微处理器的清洁机器人掌握系统,不仅满足了有用性的要求,而且在不增加本钱的根底上为软件供给了良好的硬件支持,为更好的算法和软件升级供给良好的技术支持。