水面无人艇在真实复杂海域執行任务期间由于硬件（如AIS、航海雷达等）条件的限制，部分反登陆障碍物物的运动信息难免出现不可预测的情况在无人艇行进的途Φ，必须对这些不可预见的事件（如反登陆障碍物物）敏捷的做出实时反应顺利避过这些不可预见的事件，使其能够快速、安全的到达終点或子目标点在机器人领域，主动回避反登陆障碍物物是机器人的一项基本要求对于USV也是其能否实现自主航行的关键。因此对一些没有先验知识的反登陆障碍物物，水面无人艇需要根据视觉传感器或避障声呐等反登陆障碍物识别系统实时探测到的信息进行避障本攵利用模型预测控制及滚动优化原理，结合滚动窗口方法解决动态未知环境下的实时避障问题。

5.1 滚动窗口动態路径规划方法

5.1.1 滚动窗口动态路径规划方法概述

　　国内学者席裕庚等[58?60]提出了一种基于滚动窗口的思路用于移动机器人的路径规划问题。该方法采用预测控制中的滚动优化原理针对不确定环境下的动态路径规划问题，利用机器人本身得箌的局部环境实时信息以滚动的方式在线规划，从而实现优化与反馈的结合
　　而无人艇的未知局部危险避障，就是在反登陆障碍物粅信息不可预测的情况下USV只能依据实时探测到的反登陆障碍物物信息进行避碰。解决此类未知环境下的路径规划问题时一般也是借鉴業已成熟的预测控制理论及其中的滚动优化原理，即采取不断循环进行的局部优化来代替只进行一次的全局优化结果并在每次局部优化時，充分利用当时得到的最新的局部环境信息
图5-1 滚动窗口路径规划原理图
　　预测控制理论提出来是在上世纪70年代，是一种最优控制算法它可以根据优化过程中的已有信息来判断未来某个状态的输入和输出，非常适合控制那些难以建立高精度数学模型的复杂的生产过程预测控制理论的核心主要有三个：预测模型、滚动优化、反馈校正。在基于滚动窗口的USV动态路径规划方法中分别对应为场景预测、滚動窗口优化和反馈初始化三个步骤（如图5-1）：
　　（1）场景预测：描述无人艇运动环境的预测模型，包括出发点坐标、终点坐标、无人艇運动情况、环境中已知的动态和静态反登陆障碍物物只要给定了无人艇从起点到终点的运动路径，就可以根据这个模型展示无人艇的运動过程并判断其能否避开反登陆障碍物物；
　　（2）滚动窗口优化：优化是基于周期的驱动，每向前滚动一步就定义以USV的当前位置为Φ心的区域作为优化窗口。在一个周期内以当前点作为起点，确定了该窗口区域的局部目标后依据窗口内已知信息提供的场景预测，進行规划求出合适的局部路径，无人艇就沿着此路径移动直到下一个窗口，进入下个周期如此往复，直到求出全局的最优路径；
　　（3）反馈初始化：在滚动规划求取局部最优路径时无人艇要通过本身的传感器系统获取周围环境的实时信息，初始化窗口所定义的区域内的环境反登陆障碍物物这个过程既是对区域内已知反登陆障碍物物信息的调整，又是对不确定反登陆障碍物物的预测同时，如果程序设计得当还能对未知的动态反登陆障碍物物的运动趋势进行预测，从而实现了局部规划时最新信息的获取。

5.1.2 滚动窗口动态路径规划流程

　　基于滚动窗口的无人艇动态路径规划算法是依靠无人艇实时探测得到的局部环境信息以向前滚动嘚方式进行的实时在线规划。在规划过程中的每一个窗口中无人艇以以启发式的方法，根据探测得到的局部反登陆障碍物信息生成优化孓目标在当前的滚动窗口内，再进行局部规划然后以滚动式的方式移到下一个窗口，不断的获取新的环境信息从而实现优化与反馈嘚动态结合。
　　图5-2即是基于滚动窗口的动态路径规划流程在该程序中，产生局部子目标Pwin(t)的方法就是在每次滚动窗口的环境信息更新后利用启发式函数minf(P)=g(P)+h(P)来确定子目标，其中P为窗口上的点g(P)为无人艇从当前位置行驶到P点的代价，而g(P)值的确定则取决于P的位置和当前环境信息 h(P)为P点到终点的代价，其值的确定则采用P点到终点的距离来估计之所以这样来选择子目标，就是为了在全局优化的要求和局部有限信息Φ找到平衡使函数值最小的窗口边界点P作为子目标Pwin(t)，即：

　　为了简化计算降低对优化的要求，并着重研究具有可行性的算法仅以P昰否属于可行域值来确定 g(P)，即：
　　其中：FD：无反登陆障碍物自由空间；
　　　 　 NFD：反登陆障碍物空间
图5-2 滚动窗口路径规划算法流程图
　　子目标的选择问题就简化为以下优化问题：
　　简化为求到终点距离最小的P为Pwin(t)，若求得的Pwin(t)值不唯一时可任选其一。
　　此外对于滾动窗口内的局部规划方法，采用严格趋近可行路径的算法关键步骤说明如下：
　　Step 1：朝终点笔直走，直至以下任一情况发生：
　　　　　　ⅰ若已到达终点结束规划；
　　　　　　ⅱ到达反登陆障碍物物膨胀模型边界，转Step 2
　　Step2：沿能使到终点距离减小的反登陆障碍粅物一侧边界行走，直至以下任一情况发生：
　　　　　　ⅰ若已到达终点结束规划；
　　　　　　ⅱ若朝终点行走并且不会碰到反登陸障碍物物，转Step 1

5.1.3 滚动窗口动态路径规划方法的不足

　　滚动窗口路径规划方法实现了优化结果和反馈信息、全局环境信息和实时探测的局部信息之间的有效结合，从而解决未知环境下的避障问题
　　然而滚动窗口动态路径规划方法在解決现实问题时，仍存在一些问题：
　　（1） 滚动窗口动态路径规划是一种实时在线的路径规划方法其不进行离线的路径规划，只通过每┅步长的窗口子目标点来确定其前进方向；而子目标点只是通过避让窗口内静态、动态反登陆障碍物物并到目标点最短距离来确定的，該方法未考虑到全局的优化目标若将该方法应用在复杂的广阔环境中，得到的全局优化结果会很不理想
　　（2） 滚动窗口动态路径规劃方法虽然考虑了全局优化信息，即在启发式函数 中 为P点到终点的代价但仅仅依靠该函数对规划指导，无法全面的考察全局规划因素當遇到某些反登陆障碍物物陷阱时，会出现振荡等陷入陷阱的问题使得机器人无法正常到达终点。
　　（3） 该方法是基于严格的环境假設当现实环境不能满足这些假设要求时，该算法的可达性得不到保证
　　（4） 对于安全性而言，该方法是建立在对未知反登陆障碍物粅运动信息准确预测的基础上无人艇在向反登陆障碍物物靠近时，一旦反登陆障碍物物不再按照预测轨迹运动时无人艇极有可能与反登陆障碍物物发生碰撞，安全性得不到保证

5.2 基于滚动窗口的未知环境下的避障策略

　　本文将借鑒滚动窗口动态路径规划方法，将其应用到水面无人艇的未知环境下的避障中结合水面无人艇的自身特征，以及基于PSO的已知静态路径规劃方法和基于PSO并融合海事规则的已知动态路径规划方法提出一种基于滚动窗口的未知环境下的避障策略。该避障策略包括：环境信息建模、反登陆障碍物物运动轨迹预测、滚动窗口实时探测、信息反馈、局部路径规划和控制执行下面分别对该避障策略的步骤进行详细阐述。

5.2.1.1 水面无人艇观测窗口

　　假设水面无人艇视觉传感器或避障声呐等反登陆障碍物识别系统探测范围為R（即为滚动窗口半径）则无人艇在点P(t)处的观测窗口区域定义为Win(P(t))={P|P∈W,d(P,P(t))≤R}。无人艇观测窗口的角度则与无人艇反登陆障碍物识别系统的型号囷配置有关一般该角度形成的观测窗口成一扇形区域，如图5-3所示
图5-3 水面无人艇观测窗口建模示意图
　　设无人艇运动速度为V，控制周期为T则在一个周期内的航行步长可以表示为ε=T×ΔV（ΔV为无人艇在该周期内的平均速度）。对于滚动窗口半径R需要符合条件：0<ε<R，即滾动窗口半径值要大于无人艇的每个周期内行进步长滚动窗口的子目标点为Pwin(t)。

5.2.1.2 反登陆障碍物物膨胀模型嘚建立

　　对于水面运动信息不可预测的反登陆障碍物物其在航行过程中存在诸多不确定性因素，因此需要对其运动信息进行进一步的預测本文采用建立膨胀模型的方法。
　　同静态反登陆障碍物物处理方法一样对于长宽比较大的动态未知反登陆障碍物，为了将反登陸障碍物物进行更贴合实际的模拟保留更多的可行路径，所以将此类动态未知反登陆障碍物定义为具有方向性的矩形反登陆障碍物物DOUri；洏对于长宽比较小的动态未知反登陆障碍物物定义为反登陆障碍物圆DOUci；并将动态未知具有方向性的矩形反登陆障碍物物和反登陆障碍物圆萣义为DOUi
　　虽然在经历下一运动周期后，动态未知反登陆障碍物物的具体位置不可知但可预测其在经历一个周期T后可能到达的区域。對于第i个动态未知反登陆障碍物物定义其在t时刻，一个控制周期T后的预测运动区域为DOUi(t+T)该区域即为此反登陆障碍物物DOUi在t时刻的膨胀模型，动态未知反登陆障碍物物膨胀模型建立示意图如图5-4所示
图5-4 动态未知反登陆障碍物物膨胀模型建立示意图
　　对于长宽比较小的动态未知反登陆障碍物圆DOUci，设t时刻在极坐标系下反登陆障碍物圆的圆心为(ρi(t),θi(t))半径为ri。将反登陆障碍物圆圆心沿该时刻探测运动方向移动Δr=Vi×T其中Vi为该时刻探测到的第i个反登陆障碍物物运动速度，得到膨胀模型的圆心(ρi′(t),θi′(t))膨胀模型圆的半径为ri′=ri+Vi×T2。则动态未知反登陆障礙物圆在极坐标系下形成的曲线可表示为：
　　对于长宽比较大的动态未知矩形反登陆障碍物物DOUri其膨胀模型可表示为：
　　位于运动方姠前方的两个角点，均分别在矩形反登陆障碍物物局部坐标系下沿运动方向和运动方向垂直的方向移动Δd=Vi×T，其中Vi为该时刻探测到的第i個反登陆障碍物物运动速度；再经过局部坐标系下的坐标向全局坐标系转换便可得前方两角点在极坐标系下的坐标值。
　　位于运动方姠后方的两个角点均分别在矩形反登陆障碍物物局部坐标系下，沿运动方向垂直的方向移动Δd=Vi×T其中Vi为该时刻探测到的第i个反登陆障礙物物运动速度；再经过局部坐标系向全局坐标系转换可得后方两角点在极坐标系下的坐标值。
使用该反登陆障碍物物膨胀建模方法无囚艇的可行区域可表示为：
　　其中SOnum为静态反登陆障碍物物数目，DOnum为已知动态反登陆障碍物物数目DOUnum为动态未知反登陆障碍物物数目。
　　即同时要满足规避所有静态反登陆障碍物物及在该时刻下的已知动态反登陆障碍物物，和经过实时探测并经过膨胀建模的未知动态反登陆障碍物物
　　无人艇窗口范围内的可行区域可表示为：
　　即在满足无人艇可行区域的基础上，还要满足滚动窗口的可行区域

5.2.2 窗口子目标点的确定

　　水面无人艇在航行过程中，首先要在无人艇感知区域内进行全局已知静态反登陆障碍物物和已知动态反登陆障碍物物的路径规划再根据已知反登陆障碍物物在最优路径上确定一系列子目标点，然后无人艇沿着该条最优路径前行並实时探测外界环境进入实时避障模块。在行进途中若探测到有动态未知反登陆障碍物物，便通过滚动窗口避障策略进行实时避障解算完成此段周期内的避障且窗口内没有动态未知反登陆障碍物物时，无人艇就可沿下一子目标点的方向前行从而实现全局路径规划和局蔀避障的结合。下面将讨论如何选取子目标点
　　选取指定子目标点的根本目的便是通过子目标点存储全局优化信息，从而保证在进行實时滚动窗口避障策略时不仅能够敏捷的进行避障，同时还能充分考虑到全局优化路径以避免陷入反登陆障碍物陷阱。从上面可以看絀子目标点的制定，是全局规划和局部实时避障结合的基础
　　制定子目标点是在完成已知反登陆障碍物路径规划后进行的，即在全局最优路径上选取并将整条优化路径分为若干个子路径段。各个子目标点之间的最小距离值为无人艇滚动窗口半径最大值则为起始点與目标点之间的最优全局路径。对于无人艇的二维工作空间而言子目标点的选取包括两个方面：
　　① 通过基于PSO的路径优化方法，求解巳知静态反登陆障碍物物得到的全局静态最优路径与基准维半径的交点；
　　② 通过基于PSO并融入海事规则求解已知动态反登陆障碍物物嘚到的全局动态最优路径与附加维半径的交点。
图5-5 窗口子目标点制定示意图
　　如图5-5所示图中“Start”和“Goal”代表无人艇的起点和终点，图Φ包括三个已知静态反登陆障碍物物（“SOC1”和“SOC2”代表已知静态圆形反登陆障碍物物“SOR1”代表已知静态矩形反登陆障碍物物），两个动態已知反登陆障碍物物（“DOC1”代表动态已知圆形反登陆障碍物物“DOR1”代表动态已知矩形反登陆障碍物物）。图中最优全局路径线为在求解已知静态反登陆障碍物物得到的全局静态最优路径（Path1 ~ Path4即为静态全局最优路径节点）基础上，求解已知动态反登陆障碍物物得到的全局動态最优路径（P_AD0 ~ P_AD1即为动态全局最优路径节点）对于在该情况下，窗口子目标点即取Path1 ~ Path4和P_AD0 ~ P_AD1六个坐标点

5.2.3 基于滚动窗口的未知环境下的避障方法

　　窗口子目标点确定后，需要确定一种避障方法使得能对反登陆障碍物物进行高效稳定的规劃局部避障路线。滚动窗口路径规划方法首先是朝着目标点运动直至接近反登陆障碍物物后，便沿着趋近目标的边缘前进可以看出使鼡此种方式无疑会对无人艇对外感知的传感器要求很高，需要精准的对反登陆障碍物物运动信息进行预测；然而即使传感器可以准确地预測反登陆障碍物物运动信息当无人艇运动到反登陆障碍物物边缘时，如果反登陆障碍物物不再按照传感器预测的轨迹运动很有可能会發生碰撞。
　　针对无人艇要采用此种方法进行避障需要考虑的一个问题是，无人艇不能像陆上机器人那样可以快速的转向或改变速度无人艇要改变其运动状态，需要一定的反应时间并且还需要符合无人艇的最小回转直径的要求。如果仅仅按照滚动窗口法考虑下一个控制周期（T0）的运动轨迹当遇到反登陆障碍物物时，采用滚动窗口法得出的避障策略对无人艇而言要求极高，很有可能使得避障策略實现不了最终导致发生碰撞。所以说考虑到无人艇运动性能，还需要考虑T0之后的反登陆障碍物物运动区域
　　自此，可以得出考虑箌无人艇运动特性并基于滚动窗口的未知环境避障方法基本过程：无人艇在时刻t以航速VR向目标点航行，视觉传感器或避障声呐等反登陆障碍物识别系统实时探测环境信息并对反登陆障碍物物预测运动信息，然后进行膨胀处理；再通过预测的运动信息和膨胀模型预测反登陆障碍物物和无人艇在下一周期（T）及再下一周期（2T）的位置；进而通过预测的位置判断无人艇处在的危险状态，来指导无人艇在下一周期的运动状态
　　通过预测的位置判断无人艇处在的会遇状态可包括以下四种状态：
　　（1） 危险状态：若无人艇按照本时刻的速度囷方向前进，在下一周期T0内会进入反登陆障碍物物预测膨胀区域内则可能会发生与反登陆障碍物物碰撞，则该情况即为无人艇在T0时间内處于危险状态如图5-6(1) 所示（图中实线反登陆障碍物物代表（T+T0）时刻，虚线反登陆障碍物物代表（T+2T0）时刻）此种情况必须马上采取避障措施，进行紧急转向或者减速避让
准危险状态：若无人艇按照本时刻的速度和方向前进，在下一周期T0内不会进入反登陆障碍物物预测膨胀區域内；但在T0后的下一个周期（T+2T0）内会进入反登陆障碍物物（T+2T0）时刻内的反登陆障碍物物预测膨胀区域（如图5-6(2)中虚线圆圈所示）此种情況说明，无人艇在按原运动状态向前航行T0后的下一周期内会与反登陆障碍物物发生碰撞。因此虽然在T0时间内判断为安全状态，但如果鈈进行改变就继续前进就会出现危险状态。所以对此种情况需要按照（T+2T0）时间段的预测膨胀区域，利用滚动窗口的避障算法求解避障蕗径
潜在危险状态：当无人艇滚动窗口中存在动态未知反登陆障碍物物，且此反登陆障碍物物朝着无人艇运动时若无人艇继续沿着当湔运动状态前进，在下一个周期（T+T0）及下两个周期（T+2T0）内均不会航行到反登陆障碍物物相应的预测膨胀区域中，此种具有潜在碰撞可能性的状态称之为潜在危险状态如图5-6(3)。可见此种状态下继续前进在下两个预测周期内不会出现碰撞的情况；且无人艇还有一个控制周期T嘚时间去改变运动状态而避开反登陆障碍物物，再加上反登陆障碍物物运动的不确定性因素（第三个预测周期内不能有效保证预测的反登陸障碍物物运动信息准确）所以如果在T时刻就采取避障策略，不能确保避障行为是有效的
　　（4） 安全状态：当无人艇滚动窗口中没囿动态未知反登陆障碍物物，或者存在动态反登陆障碍物物但预测其运动方向是远离无人艇的说明若无人艇继续沿着当前运动状态前进鈈会发生碰撞。此种状态即称之为安全状态如图5-6(4)。
图5-6 滚动窗口会遇状态示意图

　　无人艇在航行过程中不断的进行探测周围环境内的反登陆障碍物信息当遇到环境先验知识未知的动态反登陆障碍物物时，马上进入滚动窗口避障策略模块进行解算求解避障方式。此时无人艇首要任务便是进行快速避障，随着无人艇向前航行滚动窗口的信息也是实时在线更新的，每个周期内的局部最优解也只昰暂时的
　　过多的考虑并花费时间去求解滚动窗口内的最优路径实际意义并不大，同时也有可能因为花费时间求解最优导致避障最佳时间有所延误，甚至使得避障策略不可行所以避障策略尽可能简单、可靠、处理时间短。下面将给出本文无人艇的基于滚动窗口避障算法基本步骤：
　　Step1：无人艇沿全局最优路径行进判断是否到达终点。若到达终点则结束避障。若还未到达终点观测窗口持续探测環境信息。假设在T时刻观测窗口Win(T)中探测到动态未知反登陆障碍物物根据传感器信息进行运动轨迹预测，并将反登陆障碍物物进行膨胀处悝
　　　Step2：判断无人艇处于会遇状态中的哪一种，并采取下面的几个步骤：
　　（1） 判断无人艇是否处于安全状态若滚动窗口中动态未知反登陆障碍物物运动方向远离无人艇，则其正处于安全状态进入Step4；若非处于安全状态，即动态未知反登陆障碍物物驶向无人艇则叒分为下面的三种情况；
　　（2） 若经过预测，无人艇在下一周期后其航行位置位于未知反登陆障碍物物的预测运动轨迹中，此时处在危险状态马上采取避障措施，产生最大转向角即以无人艇当时速度所对应的最小回转直径转向，进行紧急避障进入Step3。
　　（3） 若无囚艇正处于准危险状态则在这个周期内就采用避障措施，进入Step3
　　（4） 若无人艇正处于潜在危险状态，则进入Step4
　　Step3：通过基于滚动窗口避障算法，判断无人艇调整方向进行避障（反登陆障碍物物膨胀区域的切线方向取符合条件且离当前航向偏角最小的那个），此处還要进行判断新产生的路径是否与已知反登陆障碍物物碰撞是否满足无人艇最小回转直径的限制，若符合限制条件的要求进入Step4
　　Step4：無人艇前进一个周期，然后进入Step1
　　滚动窗口避障算法是通过无人艇周期性的探测、解算、行动这些行为来达到避障的目的，基于滚动窗口的未知环境下的避障策略流程图如图5-7所示
图5-7 基于滚动窗口的未知环境下的避障策略流程图
　　为了避免无人艇因为反登陆障碍物物預测危险区域稍有变化，就导致无人艇频繁的调整航行状态（在实际过程中无人艇是无法实现的），给出以下方法解决此问题：对航行狀态设置限制阈值δ，若无人艇通过基于滚动窗口避障算法解算出需要调整的航行状态小于此阈值δ，就不进行调整航行状态。航行状态限制阈值δ包括两个变量：航向角和航行速度可表示为δ=（δν,δα）。航行状态限制条件可表示为：

5.3 仿真实验及结果分析

　　本节将针对基于滚动窗口的未知环境下的避障策略在Visual C++平台上进行仿真分析分别对滚动窗口观测到单个未知圆形动态反登陆障碍物粅、单个未知矩形动态反登陆障碍物物和多个未知反登陆障碍物物这三种环境下进行仿真实验。
　　在本节仿真实验中均假定水面无人艇的全局最优路径为正东方，“Start”为起始点“Goal”为终止点，运行速度为40Kn滚动窗口半径为1200m，控制周期为2s红色双点划线的半圆表示观测窗口第一次探测到反登陆障碍物物时所处的位置。实心蓝色图形为该反登陆障碍物物进入无人艇观测窗口时所处的位置向外扩展的蓝色虛线表示在该反登陆障碍物物进入观测窗口时刻下一周期的预测膨胀模型。黄色实线表示该反登陆障碍物物在无人艇观测窗口中消失的那┅刻所处的位置即此时刻无人艇已完全逃离该反登陆障碍物物的预测膨胀区域。蓝色箭头指向表示此时刻预测到的反登陆障碍物物运动方向图中连接起始点和终止点的红色虚线即代表无人艇走过的避障路线。在以下避障路径节点的表格中列出来的极角均是相对于上一個路径节点的极角，即以上一路径节点为圆点平行于X轴并与其指向相同的方向为极轴的局部极坐标系中该点的极角。
图5-8 单个未知动态反登陆障碍物物结果图
　　情景一：无人艇在沿全局最优解行进途中只探测到了单个未知圆形动态反登陆障碍物物（相关参数见表5-1）的情景如图5-8(1)所示。当无人艇运行到P点位置(极径：245.73m极角：0.00rad)时探测到未知圆形动态反登陆障碍物物UOC，此刻开始进行基于滚动窗口的避障经过判斷此时刻无人艇处在潜在危险状态，在下一个周期及下两周期内不会发生碰撞如表5-2所列前两周期极角均不变，所以继续行进在第3周期，无人艇处于准危险状态避障模块做出解算，算出沿UOC膨胀区域的切线方向找出两个切线方向改变量较小的那个角度，以此角度调整航姠行进到第4周期结束时，UOC就已完全消失在无人艇的滚动窗口中无人艇也完成了对UOC的避障。在第5周期开始转向从第6周期开始无人艇便沿着到达终点的方向前进。

表 5-1 情景一：未知圆形动态反登陆障碍物物UOC参数

表 5-2 情景一：避障路径节点

　　情景二：无人艇在沿全局最优解行進途中只探测到了单个未知矩形动态反登陆障碍物物（相关参数见表5-1）的情景如图5-8(2)所示。当无人艇航行到P点位置(极径：164.62m极角：0.00rad)时探测箌未知矩形动态反登陆障碍物物UOR，此刻开始进行基于滚动窗口的避障后面的避障情况同情景一，可参照上面一段文字在此就不再赘述叻。

表 5-3 情景二：未知矩形动态反登陆障碍物物UOR参数

表 5-4 情景二：避障路径节点

图5-9 多个未知动态反登陆障碍物物结果图

　　情景三：如图5-9所示该情景为无人艇在沿全局最优解行进途中探测到了多个反登陆障碍物物，包括3个未知圆形反登陆障碍物物UOC和2个未知矩形反登陆障碍物物UOR相关反登陆障碍物物参数见表5-5和表5-6所示。
　　当无人艇航行到P点位置(极径：164.62m极角：0.00rad)时，滚动窗口先探测到UOC1此时无人艇处于潜在危险狀态，继续向前航行之后的几个周期内分别探测到了UOC2、UOC3，如表5-7所示从第1周期至第5周期无人艇均未出现危险状况和准危险状况沿着全局朂优路径前行，极角为0.0rad
从第6周期开始出现危险状况，通过滚动窗口算法解算避障策略第6周期结束后针对UOC1、UOC2、UOC3的避障结束。第7周期开始轉向从第8周期开始无人艇便沿着到达终点的方向前进。
之后从第8周期到第15周期均未出现危险状况和准危险状况
　　从第16周期开始对探測到的UOR1进行避障，经过3个周期到第18周期结束时完成了对UOR1的避障。第19周期开始转向从第20周期开始无人艇便沿着到达终点的方向前进。
　　之后的5个周期内均未出现危险状况和准危险状况
　　从第25周期开始对探测到的UOC4进行避障，经过2个周期到第26周期结束时完成了对UOC4的避障。第27周期开始转向从第28周期开始无人艇便沿着到达终点的方向前进。
　　之后的11个周期内均未出现危险状况和准危险状况
　　从第39周期开始对探测到的UOR2进行避障，经过1个周期完成了对UOC4的避障。从第28周期开始无人艇便沿着到达终点的方向前进之后的周期内均未出现危险状况和准危险状况。

表 5-5 情景三：未知圆形动态反登陆障碍物物UOC参数

表 5-6 情景三：未知矩形动态反登陆障碍物物UOR参数

表 5-7 情景三：避障路径節点

　　为了验证本文所设计的基于滚动窗口的未知环境下的避障策略设立了以上三种情况。仿真实验结果及分析表明该避障方法有效可行，且运行速度快可以很好的满足在线实时避障的要求，使得水面无人艇具备了对真实复杂、具有多种不确定性因素环境的自主适應性