[发明专利]用于无人船路径跟随和避障的改进DWA动态窗口法

摘要

本发明公开了一种用于无人船路径跟随和避障的改进DWA动态窗口法，包括以下步骤:S1:首先获取左右满舵对应的最大角速度和最小角速度，令右满舵为最小角速度，左满舵为最大角速度；S2：将S1中所述的最小角度和最大角速度这个闭合区间内均匀采样任意数值个角速度，每个角速度对应一个舵角；S3：选取的模拟时间为任意数值，模拟时间间隔为任意数值，无人船速度V为任意数值；S4：将S3中所述的模拟时间、模拟时间间隔和无人船速度依次代入到无人船运动公式中。本发明中，便于寻找一种路径跟随和避障性能都好，实时性好，计算效率高的方法，此方法让无人船沿着路径行驶的时候，能够实时躲避障碍物，有利于使用。

主权项

1.用于无人船路径跟随和避障的改进DWA动态窗口法，其特征在于，包括以下步骤:/nS1:首先获取左右满舵对应的最大角速度和最小角速度，令右满舵为最小角速度，左满舵为最大角速度；/nS2：将S1中所述的最小角度和最大角速度这个闭合区间内均匀采样任意数值个角速度，每个角速度对应一个舵角；/nS3：选取的模拟时间可以为任意数值，模拟时间间隔可以为任意数值，无人船速度V可以为任意数值；/nS4：将S3中所述的模拟时间、模拟时间间隔和无人船速度依次代入到无人船运动公式中，计算出所有采样角速度在模拟时间t内每个模拟时间间隔∆t的坐标和朝向，以此来生成每个采样角速度对应的轨迹；/nS5：将S4中生成的轨迹进行评价，通过如图3所示的方法，评价无人船中心与轨迹终点连线上是否有障碍物；/nS6：S5中所述如图3所示方法中的方法1：若轨迹会使无人船碰到障碍物，则此轨迹不能选择；/nS7：S5中所述如图3所示方法中的方法2：若轨迹终点朝向和它与路径局部目标点的连线的夹角越小得分越高，S5中所述如图3所示方法中的方法3：若轨迹终点和路径终点的距离越小得分越高，S5中所述如图3所示方法中的方法4：若轨迹终点偏离路径的距离越小得分越高；/nS8：将S6中方法1排除，将S4中生成的其他轨迹利用S7中所述的方法2、方法3、和方法4进行评价，然后对S7中所述的方法进行得分并分别进行归一化处理；/nS9：将S8中所述的得分进行对比，筛选出得分最高的轨迹，此轨迹对应的舵角就是无人船此时此刻的最佳舵角。/n