[发明专利]一种自动吸尘机器人的最佳路径选择方法

权利要求书

1.一种自动吸尘机器人的最佳路径选择方法，所述的自动吸尘机器人包括两个驱动轮、与所述驱动轮连接的两个驱动电机，所述的驱动电机上安装编码器，还包括一个支撑轮，以安装在所述的自动吸尘机器人前部的障碍物检测装置，所述的驱动电机、编码器和障碍物检测装置与控制器连接，所述的控制器通过分别设置两个所述的驱动轮的速度和方向来实现所述的自动吸尘机器人的自由运动，并且根据所述的编码器的信号可以计算所述的自动吸尘机器人的相对移动距离和旋转方向，以起始位置为坐标原点，可计算当前位置的坐标（X，Y），其特征在于：所述的控制器内部设置最佳路径选择方法，所述的最佳路径选择方法包括以下步骤：

(1)、所述的自动吸尘机器人记录当前点P_i的坐标（X_i，Y_i），然后以直线运动方式前进，并且不断检测障碍物；

(2)、所述的自动吸尘机器人检测到障碍物，记录当前点P_i+1的坐标（X_i+1，Y_i+1），随机选择一个旋转方向，并以直线运动方式前进，并且不断检测障碍物；

(3)、所述的自动吸尘机器人检测到障碍物，记录当前点P_i+2的坐标（X_i+2，Y_i+2）；

(4)、计算P_i和P_i+1两点之间的距离L0=((X_i-X_i+1)²+(Y_i-Y_i+1)²)^1/2，P_i+1和P_i+2两点之间的距离L1=((X_i+1-X_i+2)²+(Y_i+1-Y_i+2)²)^1/2，P_i+2和P_i两点之间距离L2=((X_i-X_i+2)²+(Y_i-Y_i+2)²)^1/2；

(5)、比较L0，L1和L2的大小：

如果L0最大，则选择从点P_i+2到中点P_m(i,i+1)方向为新的行进方向，中点P_m(i,i+1)为点P_i和P_i+1之间的中点，中点P_m(i,i+1)的坐标为((X_i+X_i+1)/2，(Y_i+Y_i+1)/2)，则计算P_i+2→P_m(i,i+1)的方向角α为，而所述的自动吸尘机器人当前行进方向角β为；所述的自动吸尘机器人控制所述的驱动电机，实现旋转角度α-β，然后以直线运动方式前进，遇到障碍物以后返回步骤1；

如果L1最大，则选择从点P_i到中点P_m(i+1,i+2)方向为新的行进方向，中点P_m(i+1,i+2)为点P_i+1和P_i+2之间的中点，中点P_m(i+1,i+2)的坐标为（(X_i+1+X_i+2)/2，(Y_i+1+Y_i+2)/2），则计算P_i→P_m(i+1,i+2)的方向角α为，而所述的自动吸尘机器人当前行进方向角β为；所述的自动吸尘机器人控制所述的驱动电机，实现旋转角度180°到-β方向上，并返回到中点P_m(i+1,i+2)，旋转角度α+β到α方向上，然后以直线运动方式前进，遇到障碍物以后返回步骤1；

如果L2最大，则选择从点P_i+1到中点P_m(i,i+2)方向为新的行进方向，中点P_m(i,i+2)为点P_i和P_i+2之间的中点，中点P_m(i,i+2)的坐标为((X_i+X_i+2)/2，(Y_i+Y_i+2)/2)，则计算P_i+1→P_m(i,i+2)的方向角α为，而所述的自动吸尘机器人当前行进方向角β为；所述的自动吸尘机器人控制所述的驱动电机，实现旋转角度180°到-β方向上，并返回到点P_i+1，旋转角度α+β到α方向上，然后以直线运动方式前进，遇到障碍物以后返回步骤1。