主权项 |
一种清扫机器人全覆盖遍历路径规划算法的设计方法,其特征是,包括以下步骤:步骤一:选择Standard混沌方程及其仿射变换产生矩形区域内的遍历清扫轨迹;步骤二:将一个含有矩形障碍物的封闭清扫环境采用多条平行分割线沿着障碍物和清扫环境边缘对可行清扫区域进行分割,并把机器人可行清扫区域划分成若干个矩形子区域S<sub>x</sub>,其中下标x表示各个子区域的编号;步骤三:根据各个矩形子区域之间的邻接关系将矩形子区域S<sub>x</sub>组合为若干个矩形迭代子区域S<sub>I_z</sub>,其中z表示矩形迭代子区域的编号,所有的迭代子区域组合为整个可行清扫区域,并求出各个迭代子区域S<sub>I_z</sub>内的Standard仿射变换方程;步骤四:将矩形迭代子区域S<sub>I_z</sub>根据相邻关系勾画出可遍历空间的连通路,然后根据连通路求出最优子区域衔接路径;步骤五:根据最优子区域衔接路径中矩形迭代子区域S<sub>I_z</sub>的邻接关系,构造出相邻矩形迭代子区域S<sub>I_z</sub>之间的矩形过渡子区域S<sub>T_z</sub>和重复子区域S<sub>O_z</sub>,其中z表示矩形迭代子区域的编号,并求出各个矩形过渡子区域S<sub>T_z</sub>内的Standard仿射变换方程;步骤六:将矩形过渡子区域S<sub>T_z</sub>和重复子区域S<sub>O_z</sub>插入到所求出的最优子区域衔接路径中,产生全覆盖遍历连通图;步骤七:根据全覆盖遍历连通图中矩形迭代子区域的邻接关系,利用矩形过渡子区域S<sub>T_z</sub>、重复子区域S<sub>O_z</sub>和矩形过渡子区域S<sub>T_z</sub>内的Standard仿射变换所产生的遍历轨迹,进行矩形迭代子区域的自动衔接;当机器人遍历完一个迭代子区域,通过重复子区域S<sub>O_z</sub>和过渡子区域S<sub>T_z</sub>自动衔接到下一个迭代子区域,直到所有迭代子区域遍历完成为止;步骤八:根据全覆盖遍历连通图设计清扫机器人全覆盖遍历程序的流程图,用以实现机器人遍历清扫任务;在可行清扫区域内,初始化清扫机器人的起点以及清扫一次所需要的总的迭代次数,选择清扫方向为顺时针或逆时针迭代,然后根据全覆盖遍历连通图中的迭代顺序以及流程图程序,利用Standard仿射变换产生的轨迹依次实现各个矩形子区域内的遍历清扫,以及子区域的自动衔接,直至整个遍历清扫任务完成。 |