一种无人艇航行串级控制系统技术方案

本发明专利技术公开一种无人艇航行串级控制系统及其控制方法，该控制系统包括制导系统，串级控制系统和无人艇环境感知系统；无人艇环境感知系统感知航行信息并将该信息传输给制导系统和串级控制系统，无人艇环境感知系统包括导航传感器模块，距离感知模块和干扰感知模块；制导系统包括任务导航模块，反应式避障模块，海事规则避障模块和路径规划模块；串级控制系统包括主反馈回路和副反馈回路；制导系统与主反馈回路中的主控制器和无人艇轨迹反馈系统连接；副反馈回路在主反馈回路的内部，其中主控制器与副控制器和无人艇姿态反馈系统连接，副控制器与无人艇船体模型辨识系统连接。本发明专利技术可抑制外部环境的干扰，使无人挺高性能的航行。

A cascade control system for unmanned navigation

【技术实现步骤摘要】
一种无人艇航行串级控制系统
本专利技术属于无人艇
，具体涉及一种无人艇航行串级控制系统。该控制系统对于航行中强干扰有很强的抑制作用，能够实现无人艇高性能高精度跟踪期望轨迹的航行控制。
技术介绍
无人艇是一种无需人员驾驶和操作，可以自主或者半自主航行和作业的艇，主要用于执行危险以及不适合有人船只执行的任务。现如今已经广泛地应用于军事和民用领域；在军事领域，无人艇通过搭载高精度的装备和军用火炮能够实现无人侦察和船只护航的任务；在民用领域主要用于海图探测，水样收集，应急救援等。在海洋中执行任务的无人艇，由于受到风浪等外部环境的干扰，会产生横荡，纵荡和艏摇。上述干扰的存在对于无人艇高性能航行有很大的负面影响。外界的干扰不仅会降低无人艇上搭载的设备的工作效率同时还会对于无人艇的航迹产生影响，使之不能高精度的跟踪期望轨迹。因此为保证无人艇的高性能航行，需要对外界干扰作出抑制。
技术实现思路
本专利技术针对目前无人艇所面临的不可预测的外界强干扰问题，旨在提供一种无人艇航行串级控制系统。为实现专利技术目的，本专利技术采用的技术方案如下：一种无人艇航行串级控制系统，包括制导系统，串级控制系统和无人艇环境感知系统；所述无人艇环境感知系统感知航行信息并将该信息传输给所述制导系统和串级控制系统，所述无人艇环境感知系统包括导航传感器模块，距离感知模块和干扰感知模块；所述制导系统包括任务导航模块，反应式避障模块，海事规则避障模块和路径规划模块；所述串级控制系统包括主反馈回路和副反馈回路；其中副反馈回路包括无人艇船体模型辨识系统，无人艇姿态反馈系统和副控制器，主反馈回路包括主控制器，动力驱动系统，无人艇轨迹反馈系统；所述制导系统与主反馈回路中的主控制器和无人艇轨迹反馈系统连接；所述副反馈回路在主反馈回路的内部，其中所述主控制器与副控制器和无人艇姿态反馈系统连接，所述副控制器与无人艇船体模型辨识系统连接；所述无人艇环境感知系统与无人艇船体模型辨识系统和制导系统连接；所述制导系统通过无人艇环境感知系统提供的实时数据对无人艇的航迹进行规划，并且将规划航迹传输给所述主反馈回路。所述副反馈回路用于在复杂海况下抵制外界的强干扰；所述主反馈回路用来保证无人艇能够高精度的跟踪制导系统给出的期望轨迹。根据上述无人艇高性能串级控制系统，优选的，所述制导系统包括路径规划模块，任务导航模块，反应式避障模块，海事规则避障模块；所述路径规划模块与任务导航模块，反应式避障模块，海事规则避障模块连接。所述任务导航模块是根据具体任务要求对航迹进行规划的模块，并将任务要求传输给路径规划模块。所述反应式避障模块主要通过雷达获取障碍物的位置和速度等特征信息，并且将这些信息传输给路径规划模块。所述海事规则避障模块使无人艇遵守海事规则。所述路径规划模块接受任务导航模块，反应式避障模块和海事规则避障模块传输的数据，并结合视线法对已经生成的航迹进行实时的更新，并将更新都的航迹传输给主反馈回路。视线法(Lineofsight)其原理是船的航向始终瞄着目标点，以此修正风流海流引起的偏差。根据上述无人艇高性能航行串级控制系统，优选地，所述副反馈回路包括副控制器，无人艇船体模型辨识系统和姿态反馈。副控制器采用增量式PD控制器，增量式PD控制器通过本次控制量和上一次控制量的差值进行PD控制的一种算法。无人艇船体模型辨识系统主要是通过无人艇环境感知模块中的传感器确定当前无人艇的航行姿态并且接受副控制器的控制指令调整无人艇的航行姿态。无人艇姿态反馈系统用于将无人艇当前的姿态传输给副控制器，使用副控制器产生合适的控制指令。当外界出现干扰时，副反馈回路通过接受无人艇环境感知系统传输的外界干扰信息，快速调节自身的航行姿态以达到消除外界干扰的目的。根据上述无人艇高性能航行串级控制系统，优选地，所述主反馈回路包括主控制器，副反馈回路，动力驱动系统，航迹反馈。主控制器采用增量式PID控制器，增量式PID控制器通过本次和上一次控制量的差值进行PID控制的一种算法。动力驱动系统按照控制器输出指令给无人艇提供动力输出，保证无人艇的正常航行。无人艇轨迹反馈系统将无人艇当前的航迹传输给制导系统，通过与期望轨迹作差得到误差项，将误差项(期望减去反馈是误差)传输给主控制器，主控制器发出控制指令消除误差，从而达到高精度跟踪期望航迹的目的。根据上述无人艇高性能航行串级控制系统，优选地，所述无人艇环境感知系统包括导航传感器模块，距离传感器模块和干扰感知模块。其中导航传感器模块包括GPS和惯性导航模块；距离传感器模块包括ka波段雷达，海事雷达，360度光学相机；干扰感知模块包括多普勒海流传感器和风速传感器，无人艇通过这些传感器可以获得实时的风浪数据和无人艇姿态数据。其中无人艇所搭载的普勒海流传感器，风速传感器可以获得实时的风浪数据，无人艇船体模型辨识系统结合这些数据对无人艇的当前姿态进行调整；ka波段雷达，海事雷达，360度光学相机，GPS和惯性导航模块用于获得无人艇纵向、横向和艏摇方向上的位置、角度和速度信息，无人艇将该数据传输至无人艇船体模型辨识系统，制导系统。无人艇环境感知系统通过360度光学相机，ka波段雷达和海事雷达对外界位置信息进行探测，360度光学相机对近距离的目标位置信息进行探测，海事雷达和ka波段雷达对远距离的目标位置信息进行探测，通过两种传感器的结合以达到对于海上目标位置因素进行高准确度的探测。本专利技术还提出一种通过以上无人艇航行串级控制系统实现的控制方法，包括以下步骤：1)所述多普勒海流传感器，风速传感器，海事雷达，ka波段雷达，360度光学相机分别获得海流状态数据，海风状态数据，远距离目标状态数据，中距离目标状态数据和近距离目标状态数据，并将所获得的信息传输给所述制导系统和无人艇船体模型辨识系统；2)所述制导系统接受信息结合初始指令对路径进行规划，得到期望航迹数据，期望航迹数据与无人艇轨迹反馈系统传输的实际航迹作差得到误差航迹数据，并将误差航迹传输给所述主控制器；3)所述主控制器根据误差航迹数据产生主姿态控制数据，主姿态控制数据(期望无人艇的航行姿态)与无人艇姿态反馈系统传输的实际姿态(姿态反馈)作差得到姿态误差数据，姿态误差数据传输给所述副控制器。4)所述副控制器根据姿态误差数据产生副姿态控制数据，副姿态控制数据作用于无人艇船体模型辨识系统；5)所述无人艇船体模型辨识系统通过接受副姿态控制数据和无人艇环境感知系统传输的海洋干扰数据和无人艇位置数据产生驱动数据传输给所述动力驱动系统，同时调整无人艇的航行姿态；6)所述动力驱动系统接受驱动数据产生驱动力，使无人艇在海上干扰的作用下，保证无人艇能够按照期望轨迹高精度的航行。与现有技术相比，本专利技术取得的积极有益效果为：1)本专利技术中通过主回路和副回路两个回路来对无人艇进行控制，其中副回路对于无人艇航行中所遇到的干扰有很强的抑制作用；对于海面上的各种强干扰信号，副回路能够在干扰对被控对象产生很大影响之前迅速克服干扰对于无人艇航行的影响；2)无人艇在海上航行周围本文档来自技高网...

【技术保护点】
1.一种无人艇航行串级控制系统，其特征在于，包括制导系统，串级控制系统和无人艇环境感知系统；所述无人艇环境感知系统感知航行信息并将该信息传输给所述制导系统和串级控制系统，所述无人艇环境感知系统包括导航传感器模块，距离感知模块和干扰感知模块；所述制导系统包括任务导航模块，反应式避障模块，海事规则避障模块和路径规划模块；所述串级控制系统包括主反馈回路和副反馈回路；其中副反馈回路包括无人艇船体模型辨识系统，无人艇姿态反馈系统和副控制器，主反馈回路包括主控制器，动力驱动系统，无人艇轨迹反馈系统；/n所述制导系统与主反馈回路中的主控制器和无人艇轨迹反馈系统连接；所述副反馈回路在主反馈回路的内部，其中所述主控制器与副控制器和无人艇姿态反馈系统连接，所述副控制器与无人艇船体模型辨识系统连接；所述无人艇环境感知系统与无人艇船体模型辨识系统和制导系统连接；所述制导系统通过无人艇环境感知系统提供的实时数据对无人艇的航迹进行规划，并且将规划航迹传输给所述主反馈回路。/n

【技术特征摘要】
1.一种无人艇航行串级控制系统，其特征在于，包括制导系统，串级控制系统和无人艇环境感知系统；所述无人艇环境感知系统感知航行信息并将该信息传输给所述制导系统和串级控制系统，所述无人艇环境感知系统包括导航传感器模块，距离感知模块和干扰感知模块；所述制导系统包括任务导航模块，反应式避障模块，海事规则避障模块和路径规划模块；所述串级控制系统包括主反馈回路和副反馈回路；其中副反馈回路包括无人艇船体模型辨识系统，无人艇姿态反馈系统和副控制器，主反馈回路包括主控制器，动力驱动系统，无人艇轨迹反馈系统；
所述制导系统与主反馈回路中的主控制器和无人艇轨迹反馈系统连接；所述副反馈回路在主反馈回路的内部，其中所述主控制器与副控制器和无人艇姿态反馈系统连接，所述副控制器与无人艇船体模型辨识系统连接；所述无人艇环境感知系统与无人艇船体模型辨识系统和制导系统连接；所述制导系统通过无人艇环境感知系统提供的实时数据对无人艇的航迹进行规划，并且将规划航迹传输给所述主反馈回路。


2.根据权利要求1所述的无人艇航行串级控制系统，其特征在于，所述制导系统中，所述任务导航模块，反应式避障模块，海事规则避障模块分别与所述路径规划模块连接；所述任务导航模块是根据具体任务要求对航迹进行规划的模块，并将任务要求传输给路径规划模块；所述反应式避障模块主要通过雷达获取障碍物的位置和速度等特征信息，并且将这些信息传输给路径规划模块；所述海事规则避障模块使无人艇遵守海事规则；所述路径规划模块接受任务导航模块，反应式避障模块和海事规则避障模块传输的数据，并结合视线法对已经生成的航迹进行实时的更新，并将更新的航迹传输给所述主反馈回路。


3.根据权利要求1所述的无人艇航行串级控制系统，其特征在于，所述副控制器采用增量式PD控制器，所述无人艇船体模型辨识系统主要是通过所述无人艇环境感知模块中的传感器确定当前无人艇的航行姿态并且接受所述副控制器的控制指令调整无人艇的航行姿态；所述无人艇姿态反馈系统用于将无人艇当前的姿态传输给所述副控制器，使副控制器产生合适的控制指令；当外界出现干扰时，所述副反馈回路通过接受无人艇环境感知系统传输的外界干扰信息，快速调节自身的航行姿态以达到消除外界干扰的目的。


4.根据权利要求1所述的无人艇航行串级控制系统，其特征在于，所述主控制器采用增量式PID控制器，所述动力驱动系统按照主控制器输出指令...

【专利技术属性】
技术研发人员：王曰英，董佳煜，彭艳，罗均，谢少荣，蒲华燕，
申请(专利权)人：上海大学，
类型：发明
国别省市：上海;31