欢迎来到知嘟嘟! 联系电话:13336804447 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13336804447
知嘟嘟经纪人
收藏
专利号: 2020108386091
申请人: 南京工程学院
专利类型:发明专利
专利状态:未下证
专利领域: 家具;家庭用的物品或设备;咖啡磨;香料磨;一般吸尘器
更新日期:2026-11-16
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种扫拖一体机器人清洁路径规划方法,所述的扫拖一体机器人侧壁边缘设置有沿边传感器,所述的扫拖一体机器人侧壁均匀设置有若干碰撞传感器,所述的扫拖一体机器人顶部设置有图像测距导航系统,其特征在于:通过构建可视化地图,规划初步清洁路径;

机器人在按照初步清洁路径执行扫拖过程中对路况和障碍物分布进行检测,根据障碍物属性和分布情况对障碍物周围路径进行重新规划,具体步骤如下:步骤1,确定清洁区域边界,构建可视化地图,建立初始坐标系,在清洁区域内规划初步清洁路径;

步骤2,当机器人在按照初步清洁路径扫拖过程中,图像测距导航系统检测机器人行进方向的障碍物,得到障碍物的尺寸、位置坐标和障碍物的对角线的最大长度,若障碍物的对角线的最大长度大于机器人边长a的长度,判定障碍物为大型障碍物;若障碍物的对角线的最大长度小于等于机器人边长a的长度,判定障碍物为小型障碍物;

步骤3,若障碍物为小型障碍物,进一步判定障碍物是否为移动障碍物;

步骤3.1,若障碍物在设定时间内未发生位移,判定为固定障碍物,此时,记录小型障碍物位置,沿边传感器触发,机器人沿着障碍物边缘进行扫拖,遇到初步清洁路径时,与初步清洁路径对接;

步骤3.2,若障碍物在设定时间内发生位移,判定为移动障碍物,此时,机器人向前进方向一侧旋转设定角度,沿边传感器检测不到障碍物,沿边传感器不触发,机器人回正,继续按照初步清洁路径进行扫拖;

步骤4,若障碍物为大型障碍物,则记录大型障碍物中心位置及机器人首次检测到障碍物的机器人位置W1,机器人沿着障碍物的一边缘继续按弓型路径扫拖,在扫拖过程中,机器人运动到障碍物边缘且离W1位置最远的W2位置时,沿边传感器触发,机器人沿着障碍物未扫拖的边缘扫拖到W1位置,机器人原地旋转到初步清洁路径运动方向上,与初步清洁路径对接;

步骤5,在对障碍物周围进行扫拖时,对障碍物分布的疏密程度进行判定,若障碍物与相邻障碍物之间的最小距离小于机器人边长,则机器人对该障碍物进行沿边扫拖时执行Y形清洁路径,所述的机器人执行Y形清洁路径用于防止机器人出现行进卡死的状态。

步骤6,清洁区域扫拖完毕后对障碍物所占位置进行检测,若障碍物移除,对障碍物所在区域范围进行弓形路径规划,对临时障碍物所在区域进行清洁补偿。

2.如权利要求1所述的一种扫拖一体机器人清洁路径规划方法,其特征在于:所述的步骤1中初始坐标系包括基坐标系和机器人本体坐标系,所述的基坐标系以充电桩中心作为基坐标系原点O,充电桩中心与初始位置的机器人中心连线的方向为X轴正方向,俯视充电桩,右侧为Y轴正方向,建立基坐标系XOY;所述的机器人本体坐标系以机器人中心为坐标系原点O',机器人朝前方向为X'轴正方向,机器人正前行进方向的右侧为Y'轴正方向,建立机器人本体坐标系X'O'Y'。

3.如权利要求2所述的一种扫拖一体机器人清洁路径规划方法,其特征在于:所述的清洁区域边界获取方法为机器人从待清洁区域的充电桩位置出发,沿边传感器沿着墙和贴墙的障碍物前进,最后回到充电桩,记录机器人中心在基坐标系内的行驶路径。

4.如权利要求3所述的一种扫拖一体机器人清洁路径规划方法,其特征在于:所述的机器人采集障碍物尺寸和位置通过利用不同位置的多组固定障碍物图像形成的视差,将采集的图像信息通过三维立体解算成三维空间结构,得到固定障碍物的尺寸和在基坐标系下的位置坐标。

5.如权利要求3所述的一种扫拖一体机器人清洁路径规划方法,其特征在于:所述的机器人按照弓形路径规划扫拖时,行驶状态包括当机器人正前方的碰撞传感器发生碰撞时,机器人朝向机器人本体坐标系的T方向旋转90°,沿边传感器触发,沿墙扫拖机器人边长的长度,向机器人本体坐标系的T方向再旋转90°,继续执行扫拖工作,若又检测到墙壁,重复上述操作;所述的机器人本体坐标系的T方向为机器人本体坐标系Y'轴的正方向或负方向。

6.如权利要求1所述的一种扫拖一体机器人清洁路径规划方法,其特征在于:所述的步骤5中机器人执行Y形清洁路径的具体方法包括:当机器人对密集区域障碍物进行沿边扫拖时,若机器人一侧面碰到障碍物,记录碰撞位置,碰撞传感器触发,向碰撞点相对方向旋转设定角度,若在旋转过程中机器人侧面没有碰到障碍物,沿边传感器触发,重新对当前位置进行路径规划,机器人沿着障碍物边缘进行工作,遇到初步清洁路径时,与初步清洁路径对接;

若在旋转过程中机器人的同侧或异测又一次碰到障碍物,记录碰撞位置,机器人向上一次旋转方向的相反方向,继续旋转上次旋转角度的一半角度;若再次碰撞,重复操作,在一次旋转后碰不到障碍物时,沿边传感器触发,重新对当前位置进行路径规划,机器人沿着障碍物边缘进行工作,遇到初步清洁路径时,与初步清洁路径对接;

当机器人对密集区域障碍物进行沿边扫拖时,若机器人两侧面同时碰到障碍物,记录当前位置,机器人后退机器人边长a的一半距离,机器人旋转180°,寻找机器人周围距离最近的未扫拖的初步清洁路径,与初步清洁路径对接。