[发明专利]楼梯清洁机器人在踏步上移动时的防跌落及碰撞处理方法

摘要

本发明公开了一种楼梯清洁机器人在踏步上移动时的防跌落及碰撞处理方法，机器人车身安装测距传感器、接近传感器和接触式传感器。前方的接近传感器斜向下探测其是否有遮挡及判断机器人行走的前方是否为空，防止机器人从踏步两端跌落；机器人在踏步上转身时，接近传感器用于判断下方是否为空，防止机器人万向轮后轮从当前台阶踏步上踏空，防止机器人跌落；测距传感器保证机器人的一侧与上一级台阶的踢面保持基本平行，相距在安全距离X附近；接触式传感器通过接触板探测机器人前方是否触碰到障碍物，用于判断机器人行走的前方是否碰到墙壁或防护栏，并做出正确处理。本发明可有效解决楼梯清洁机器人跌落及碰撞问题，方法可靠通用性高。

主权项

一种楼梯清洁机器人在踏步上移动时的防跌落及碰撞处理方法，其特征是：所述机器人包括：两个车身下方的驱动轮，驱动机器人前进、后退和转弯；机器人车身下方前后端分别有一个万向轮前轮和万向轮后轮，一方面起到支撑机器人作用，另一方面方便机器人转弯；有用于控制机器人的单片机，机器人车身两侧分别安装第一、第二测距传感器及第三、第四测距传感器，用于检测机器人在踏步上行走时，车身一侧与上一级台阶踢面之间的距离，使其在一个安全范围内，保证机器人不跌落不碰撞；机器人车身前端上方安装斜向下探测的第一接近传感器和前端安装第一、第二接触式传感器，机器人车身后端下方安装向下探测的第二、第三接近传感器；第一接近传感器在一定范围内，探测其正前方是否有遮挡；对于楼梯踏步两端无防护栏或墙壁的，第一接近传感器用于判断机器人行走的前方是否为空，防止机器人从踏步两端跌落；当机器人在踏步上转身，以及准备下楼时，第二、第三接近传感器用于判断下方是否为空，防止机器人万向轮后轮从当前台阶踏步上踏空，防止机器人跌落；第一、第二接触式传感器通过接触板探测机器人前方是否触碰到障碍物，对于楼梯两端有防护栏或墙壁的，用于判断机器人行走的前方是否碰到墙壁或防护栏。