[发明专利]一种智能移动设备通过狭窄通道的方法

说明书

本发明公开了一种智能移动设备通过狭窄通道的方法，通过采用算法公式的计算来确定最优路径。该方法使智能移动设备在狭窄通道中行走更平滑，更易于保持直线，由于计算了中心线两侧障碍物对于行走的权重影响，局部路径规划会偏向于行走过道中间，从而更好的通过复杂狭窄区域。在结算结果中也可以进一步加入平滑因子，减少障碍物距离智能移动设备权重的影响，在不发生碰撞的前提下，让智能移动设备在大多数情况下保持直行。

技术领域

本发明涉及路径规划领域，特别是一种智能移动设备通过狭窄通道的方法。

背景技术

狭窄路径规划是路径规划中在实际应用场景中普遍遇到的问题。目前较为流行的路径规划算法，大多为了提高规划效率，在最短路径计算算法上面。而是实际在业务上，我们需要机器人运动到我们所指定的点，而该点对于目前的算法来说并不是一个最优的到达点，因此，机器人只会停在一个相对较优化的点而不是真正到达我们指定的目标点。例如，在一些狭窄通道场景下，如：高铁车厢，飞机内舱，教室课桌间，需要智能移动设备穿过这些场景来完成一些工作或者学习的任务。在通过狭窄通道的时候，智能移动设备往往会容易陷入局部路径最优，在下一段路径中，运动轨迹不够平滑，因为碰到障碍物从而无法到达终点。

发明内容

本发明的目的是为了解决背景技术中通过狭隘通道，无法作出正确的运行轨迹，从而浪费时间和影响工作和学习效率的问题，设计了一种智能移动设备通过狭窄通道的方法。

实现上述目的本发明的技术方案为，一种智能移动设备通过狭窄通道的方法，设定m条模拟路径，每条路径记录的时刻个数为n，通过在每条路径上使每个运动时刻f(x)的变化率最大，且下一个时刻的f(x)趋向于0，来确定智能移动设备通过狭窄通道的最优路径，具体公式如下：

其中，所述S_L’和所述S_R’为每个运动时刻t，智能移动设备行进过程中遇到的障碍物与分割线段L_割、线段PA和线段PB在航向角α_L和航向角α_R夹角范围内包含松弛间隔D围成的面积；

所述分割线段L_割为智能移动设备在行进状态中，通过雷达检测到障碍物上的两个点A和B连成的线段AB与中心线L的交点P与智能移动设备底盘的中心点，也就是坐标原点O的连线；

所述航向角α_L为障碍物检测点A和坐标原点O之间连接的线段与中心线L之间的夹角；

所述航向角α_R为障碍物检测点B和坐标原点O之间连接的线段与中心线L之间的夹角；

所述线段PA和所述线段PB分别为交点P到障碍物上的两个点A和B之间的距离；

所述松弛间隔D为平行于智能移动设备底盘正向前进的中心线L的直线与中心线L的间隔距离。

为了对本技术方案进行进一步补充，所述S_L’和S_R’的计算条件如下：

a：S_R＞S_L时，S_R’＝S_R－S_D，S_L’＝S_L+S_D；

b：S_R＜S_L时，S_R’＝S_R+S_D，S_L’＝S_L－S_D；