[发明专利]一种自动吸尘机器人的随机路径规划方法

摘要

公开了一种自动吸尘机器人的随机路径规划方法，所述的自动吸尘机器人包括两个驱动轮、与所述驱动轮连接驱动电机，所述的驱动轮上安装编码器，还包括一个支撑轮，以及安装在前部的障碍物检测装置，所述的驱动电机、编码器和障碍物检测装置与控制器连接，所述的控制器内部设置随机路径规划方法，所述的随机路径规划方法包括以下步骤：(1)、记录当前点Pi的坐标（Xi，Yi），然后直线前进；(2)、检测到障碍物，记录当前点Pi+1的坐标（Xi+1，Yi+1），随机选择一个旋转方向，并直线前进；(3)、检测到障碍物，记录当前点Pi+2的坐标（Xi+2，Yi+2）；(4)、计算Pi和Pi+1两点之间的中点Pm=（(Xi+Xi+1)/2，(Yi+Yi+1)/2）；(5)、选择从点Pi+2到中点Pm的方向为新的行进反向，则计算Pi+2→Pm的方向角α，而当前行进方向角β；(6)、旋转角度α‑β，然后直线前进。

主权项

1.一种自动吸尘机器人的随机路径规划方法，所述的自动吸尘机器人包括两个驱动轮、与所述驱动轮连接的两个驱动电机，所述的驱动电机上安装编码器，还包括一个支撑轮，以及安装在所述的自动吸尘机器人前部的障碍物检测装置，所述的驱动电机、编码器和障碍物检测装置与控制器连接，所述的控制器通过分别设置两个所述的驱动轮的速度和方向来实现所述的自动吸尘机器人的自由运动，并且根据所述的编码器的信号可以计算所述的自动吸尘机器人的相对移动距离和旋转方向，以起始位置为坐标原点，可计算当前位置的坐标（X，Y），其特征在于：所述的控制器内部设置随机路径规划方法，所述的随机路径规划方法包括以下步骤：(1)、所述的自动吸尘机器人记录当前点Pi的坐标（Xi，Yi），然后以直线运动方式前进，并且不断检测障碍物；(2)、所述的自动吸尘机器人检测到障碍物，记录当前点Pi+1的坐标（Xi+1，Yi+1），随机选择一个旋转方向，并以直线运动方式前进，并且不断检测障碍物；(3)、所述的自动吸尘机器人检测到障碍物，记录当前点Pi+2的坐标（Xi+2，Yi+2）；(4)、计算Pi和Pi+1两点之间的中点Pm=（(Xi+Xi+1)/2，(Yi+Yi+1)/2）；(5)、选择从点P_i+2到中点P_m的方向为新的行进反向，则计算P_i+2→P_m的方向角α为，而所述的自动吸尘机器人当前行进方向角β为；(6)、所述的自动吸尘机器人控制所述的驱动电机，实现旋转角度α‑β，然后以直线运动方式前进，遇到障碍物以后返回步骤1。