[发明专利]一种自动吸尘机器人的z字形回归路径规划方法

摘要

公开一种自动吸尘机器人的z字形回归路径规划方法，所述的自动吸尘机器人包括两个驱动轮、与所述驱动轮连接的两个驱动电机，所述驱动电机上安装编码器，还包括一个支撑轮，以安装在前部的障碍物检测装置和安装在顶部的全向红外接受装置，所述的驱动电机、编码器、障碍物检测装置和全向红外接受装置与控制器连接，还包括提供充电电源的充电座，所述的充电座顶部设置红外信号发射装置，所述的红外信号发射装置向前发射直线型特征信号，所述的控制器内部设置回归路径规划方法，所述的回归路径规划方法包括4个步骤，相邻两次碰到障碍物以后的旋转方向相反，并且控制旋转角度，保证行走路径为Z字形，这样可以提高搜寻速度，保证回归成功率。

主权项

1.一种自动吸尘机器人的z字形回归路径规划方法，所述的自动吸尘机器人包括两个驱动轮、与所述驱动轮连接的两个驱动电机，所述驱动电机上安装编码器，还包括一个支撑轮，以安装在前部的障碍物检测装置和安装在顶部的全向红外接受装置，所述的驱动电机、编码器、障碍物检测装置和全向红外接受装置与控制器连接，所述的控制器通过分别设置两个所述驱动轮的速度和方向来实现所述自动吸尘机器人的自由运动，并且根据所述的编码器的信号可以计算所述的自动吸尘机器人的相对移动距离L和旋转角度α，还包括提供充电电源的充电座，所述的充电座顶部设置红外信号发射装置，所述的红外信号发射装置向前发射直线型特征信号，其特征在于：所述的控制器内部设置回归路径规划方法，所述的回归路径规划方法包括以下步骤：(1)、所述的自动吸尘机器人以直线运动方式前进，并且不断检测障碍物和直线型特征信号，如果检测到障碍物则进入步骤2，如果检测到直线型特征信号，则进入步骤4；(2)、所述的自动吸尘机器人后退一段距离以避开障碍物，向右旋转角度α，所述的旋转角度α为随机角度并满足：90°<α<180°，然后以直线运动方式前进，并且不断检测障碍物和直线型特征信号，如果检测到障碍物则进入步骤3，如果检测到直线型特征信号，则进入步骤4；(3)、所述的自动吸尘机器人后退一段距离以避开障碍物，向左旋转角度β，所述的旋转角度β为随机角度并满足：90°<β<180°，返回步骤1；(4)、所述的自动吸尘机器人进入与所述的充电座对接充电的过程。