1.一种基于物联网技术的家居机器人路径规划方法,其特征在于,包括如下步骤:步骤1、构建家居环境地图;针对室内家居的复杂环境,室内环境的模型经常更新,实时调整地图;
步骤2、静态路径规划;家居机器人采用栅格建模的策略将环境分成若干网格区域,采用蚁群算法进行全局路径规划,采用拓展树随机优化方法对蚁群算法进行优化,进而实现家居机器人的全局静态路径规划;
采用蚁群算法进行全局路径规划的具体步骤为:假设蚂蚁的总数量为M,节点之间的信息素用矩阵Pheromone表示,最优路径长度为BestLength,最优路径为BestTour,每只蚂蚁都有各自的内存,来存储该蚂蚁已经访问过的节点,进而避免该蚂蚁对此节点进行第二次搜索;另外建立一个允许访问的节点表来表示该蚂蚁访问的节点,使用一个矩阵来存储该蚂蚁在一次迭代中经过的路径所释放出的信息素信息;假定算法总共运行Maxgen次,当前迭代次数为t;
其步骤如下:
步骤a、参数初始化设置;
蚂蚁的数量为k,信息素启发因子为α,期望启发因子为β,信息素挥发因子ρ,信息素的强度为Q;
步骤b、循环次数t=t+1;
步骤c、蚂蚁的禁忌表索引号k=1;
步骤d、蚂蚁数目k=k+1;
步骤e、蚂蚁个体根据状态转移概率公式计算的概率选择元素并前进,起始点的概率分布根据如下公式进行计算:其中t
步骤f、修改禁忌表指针,即选择好之后将蚂蚁移动到新的节点,并把该节点移动到该蚂蚁个体的禁忌表中;
步骤g、若集合中节点未遍历完,即k
步骤h、更新信息素,信息素更新公式如下:其中Δt
步骤i、如果达到最大迭代次数Maxgen,算法终止,输出最优路径BestTour和最优路径长度BestLength;否则,转至步骤b;
采用拓展树随机优化方法对蚁群算法进行优化,其对于蚁群算法全局路径规划优化的步骤如下:步骤2a、输入待优化路径,元拓展节点输入序号设置为1;
步骤2b、元扩展节点位置向外扩展;若扩展节点触碰边界或者障碍物则该方向停止扩展并且将该方向的值设为INF,且停止扩展;若扩展节点属于待优化路径且元扩展节点与扩展节点之间直线可达,用元扩展节点与扩展节点之间直线路径代替待优化路径中元扩展节点与扩展节点之间路径,生成一条待选择路径,将值设为路径长度,停止扩展;
步骤2c、元节点所有方向达到停止条件,选择值最小的待选择路径更新待优化路径;
步骤2d、元扩展节点序号自增,重复步骤2b和步骤2c,直到元扩展节点序号达到最大,输出优化路径;
步骤3、动态避障;移动家居机器人采用融合社会力模型和卡尔曼滤波的轨迹预测方案,对移动障碍物进行轨迹预测,实现对于局部路径规划中动态障碍物的避障和路径规划。
2.如权利要求1所述的基于物联网技术的家居机器人路径规划方法,其特征在于,步骤1中,构建家居环境地图具体包括如下步骤:步骤11、机器人循着家居环境边界一周,采用激光雷达和摄像头建立起家居环境边界模型;
步骤12、将室内的障碍物进行几何化处理,将其近似为几何多边形的形状;
步骤13、建立环境栅格地图,将所有的障碍物在栅格地图根据不同障碍物的属性:固定障碍物、移动障碍物,初始点,目标点进行划分表示。
3.如权利要求1所述的基于物联网技术的家居机器人路径规划方法,其特征在于,步骤2中,家居机器人采用栅格建模的策略将环境分成若干网格区域具体步骤为:家居机器人将整体家居环境分成若干网格区域并对环境地图进行栅格建模,包含对整个工作区域中不规则障碍物进行规则化操作,根据障碍物的尺寸的大小,设置一个栅格占有率参数,将部分占据栅格转化为自由栅格和完全占据栅格进而完成上述规则化操作:式中occupancy表示当前栅格占比,即障碍物占栅格面积的比例;Ratio为自定义的栅格占有率参数;
采用栅格法进行建模,把机器人的工作空间分解成一系列具有二值信息的网格单元,建立的栅格被分为自由栅格和障碍栅格,无障碍物的栅格被称为自由栅格,而包含障碍物则称为障碍栅格,通过这些栅格表示是否有障碍物。
4.如权利要求1所述的基于物联网技术的家居机器人路径规划方法,其特征在于,步骤3中,实现局部路径规划中动态避障具体包括如下步骤:步骤31、建立卡尔曼滤波预测模型,其数学模型由状态方程和观测方程构成;
X
Z
其中,X
卡尔曼滤波模型的时间更新是利用系统的状态方程获取下一时刻状态系统的先验估计值:X
P
卡尔曼滤波模型的测量更新是利用观测值对于上一步的估计值进行修正:K
X
P
其中,K
步骤32、由于预测过程终点采样时间很短,目标再采样时间内运动看成匀速运动,分别在X和Y方向上的状态进行估计,得到运动状态方程为:其中,
步骤33、建立基于社会力模型的运动模型,其数学模型主要由状态方程和观测方程构成,SFM是一种经典微观模型,其运动学方程为:其中,m
f
其中,
f
其中,f
其中,
其中,r
r
d
t
步骤34、将基于卡尔曼滤波的轨迹预测方法和基于社会力模型的运动模型融合:其中,ε
更新机制触发条件社会力预测值和整体最优估计值其中,
5.一种应用如权利要求1所述的基于物联网技术的家居机器人路径规划方法的系统,其特征在于,包括:主控系统、电源模块、激光雷达、摄像头模块、传感器模块、RFID感应器模块、手柄控制模块、显示模块、光电编码器、驱动电机模块和电源模块;电源模块用于给各个模块供电,激光雷达用于家居机器人的建立环境地图和障碍物位置信息的判断,摄像头模块用于物品识别和路径规划,传感器模块包括三轴传感器、三轴加速器和三轴磁力计,用于避障和定位,驱动电机模块用于控制家居机器人行动,光电编码器将机械量转换为数字量,显示模块用于机器人端手动添加指令,手柄控制模块通过蓝牙使用手柄遥控家居机器人,RFID感应器模块用于家居机器人的有线或无线通讯,主控系统控制各个模块。
6.如权利要求5所述的基于物联网技术的家居机器人路径规划系统,其特征在于,基于物联网技术的家居机器人路径规划系统还包括安全保护模块,用于工作中发生意外情况下能及时切断电源,防止驱动电机模块被烧毁。