欢迎来到知嘟嘟! 联系电话:13095918853 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13095918853
知嘟嘟经纪人
收藏
专利号: 2018102287644
申请人: 杭州晶一智能科技有限公司
专利类型:发明专利
专利状态:已下证
专利领域: 控制;调节
更新日期:2024-02-28
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种基于历史数据分析的自动吸尘机器人最优路径规划方法,所述的自动吸尘机器人包括两个驱动轮、与所述驱动轮连接的两个驱动电机,所述的驱动电机上安装编码器,还包括一个支撑轮,以安装在所述的自动吸尘机器人前部的障碍物检测装置,所述的驱动电机、编码器和障碍物检测装置与控制器连接,所述的控制器通过分别设置两个所述的驱动轮的速度和方向来实现所述的自动吸尘机器人的自由运动,并且根据所述的编码器的信号可以计算所述的自动吸尘机器人的相对移动距离和旋转方向,以起始位置为坐标原点,可计算当前位置的坐标(x,y),其特征在于:所述的控制器内部设置最优路径规划方法,所述的最优路径规划方法包括以下步骤:(1)、设置数据链表L0={Pi(xi,yi)},其中,i=0,1,2......N-1,xi和yi为坐标值,N为数据链表L0的长度,数据链表L0为近期所述的自动吸尘机器人检测障碍物以后停止位置的坐标数据;

(2)、所述的自动吸尘机器人以直线运动方式前进,并且不断检测障碍物;当检测到障碍物时,所述的自动吸尘机器人停止,并记录当前位置的坐标(x,y),存入数据链表L0,然后进入步骤3;

(3)、求取数据链表L0的中心点O(xo,yo),以中心点O为中心提取数据链表L0中的轮廓线段Sj(m,n),并存入数据链表L1,其中,m=0,1,2......N-1,n=0,1,2......N-1,j=0,1,

2......M-1,并且M

(4)、中心点O与数据链表L1中的轮廓线段Sj(m,n)组成三角区域,计算OPm方向角θ1=,OPn方向角θ2= ,以及数据链表L0中的点Pi(xi,yi)与中心点O形成的方向角θ3= ,如果对于数据链表L0中所有的点Pi(xi,yi),同时 都成立,则该三角区域中无任何点出现,

表明轮廓线段Sj(m,n)对应的方向没有清扫过,则在数据链表L1保留该轮廓线段Sj(m,n);相反,则在数据链表L1删除轮廓线段Sj(m,n);

(5)、计算数据链表L1中的轮廓线段Sj(m,n)的长度Wj= ,

比较轮廓线段Sj(m,n)的长度Wj的大小,取长度最大的轮廓线段Smax(m,n),轮廓线段Smax(m,n)相对中心点O的方向角α= ;所述的自动吸尘机器人选择方向角α为接下来的清扫方向。

2.根据权利要求1所述的一种基于历史数据分析的自动吸尘机器人最优路径规划方法,其特征在于:在步骤2中,当前位置的坐标(x,y)存入数据链表L0,按照如下步骤:令Pi(xi,yi)=Pi-1(xi-1,yi-1) ,i=1,2,3.....N-1;然后P0(x0,y0)=(x,y),完成链表操作。

3.根据权利要求1所述的一种基于历史数据分析的自动吸尘机器人最优路径规划方法,其特征在于:在步骤3中,数据链表L0的中心点O(xo,yo)的坐标计算方法为:搜索数据链表L0中坐标数据的最大最小值:xmax,xmin,ymax,ymin;

计算xo= ,yo= 。

4.根据权利要求1所述的一种基于历史数据分析的自动吸尘机器人最优路径规划方法,其特征在于:在步骤3中,以中心点O为中心提取数据链表L0中的轮廓线段Sj(m,n),采用以下步骤:计算数据链表L0中的点Pi(xi,yi)与中心点O(xo,yo)的距离Di=,求距离最大的点PM(xM,yM);

以PM(xM,yM)为顶点,计算数据链表L0中的点Pi(xi,yi)与中心点O(xo,yo)形成的角度β=,取角度β最大的点为轮廓点,记为PN(xN,yN),因此形成数据S0(M,N),并存入数据链表L1;

再以PN(xN,yN)为顶点,连续寻找轮廓点,并存入数据链表L1,直到返回点PM(xM,yM),结束返回。