1.一种紧耦合导航方法，应用于水下自主航行器，其特征在于，所述方法包括：获取视觉惯性导航系统的惯性因子和视觉因子，并分别根据所述惯性因子和视觉因子计算惯性因子残差和视觉因子残差，所述惯性因子包括所述视觉惯性导航系统中IMU的惯性状态信息，所述视觉因子包括图像特征点的逆深度；获取长基线定位系统的全局因子，根据所述全局因子计算全局因子残差，所述全局因子包括所述水下自主航行器与所述长基线定位系统中应答器的斜距；根据所述惯性因子、视觉因子和全局因子构建因子图，并采用基于滑动窗口的紧耦合方式将所述因子图内的惯性因子、视觉因子和全局因子进行融合，构建紧耦合模型；根据所述惯性因子残差、视觉因子残差和全局因子残差对所述紧耦合模型进行优化，得到所述水下自主航行器的定位结果。
2.如权利要求1所述的紧耦合导航方法，其特征在于，所述根据所述惯性因子、视觉因子和全局因子构建因子图，包括；以所述水下自主航行器在世界坐标系中的位姿作为所述因子图的节点，所述位姿包括位置和方向；以所述惯性因子作为所述因子图两个连续节点之间的第一局部约束；以所述视觉因子作为所述因子图每个节点的第二局部约束，以所述全局因子作为所述因子图每个节点的全局约束。
3.如权利要求2所述的紧耦合导航方法，其特征在于，所述采用基于滑动窗口的紧耦合方式将所述因子图内的惯性因子、视觉因子和全局因子进行融合，构建紧耦合模型，包括：获取所述视觉惯性导航系统中相机坐标系到载体坐标系的第一相对位姿；通过所述视觉惯性导航系统和长基线定位系统分别获取所述水下自主航行器的局部定位轨迹和全局定位轨迹，并将所述局部定位轨迹和全局定位轨迹对齐，得到所述视觉惯性导航系统中载体坐标系到ENU坐标系的旋转矩阵和平移向量，并根据所述旋转矩阵和平移向量计算所述载体坐标系到ENU坐标系的第二相对位姿；基于所述第一相对位姿和第二相对位姿，将所述滑动窗口内惯性因子、视觉因子和全局因子整合为一个状态向量；确定所述滑动窗口时间周期，根据所述滑动窗口时间周期内的状态向量构建紧耦合模型。
4.如权利要求3所述的紧耦合导航方法，其特征在于，所述将所述局部定位轨迹和全局定位轨迹对齐，得到所述视觉惯性导航系统中载体坐标系到ENU坐标系的旋转矩阵和平移向量，包括：选取所述全局定位轨迹的一个位置点作为参考点，计算所述参考点所对应的所述水下自主航行器的全局定位信息，将所述参考点作为ENU坐标系的原点；将所述全局定位轨迹所对应的全局定位信息从ECEF坐标系转换为ENU坐标系，获取所述水下自主航行器在ENU坐标系下的全局定位信息；采用插值法将所述水下自主航行器在ENU坐标系下的全局定位信息和所述局部定位轨迹的定位信息的时间戳对齐，得到所述视觉惯性导航系统中载体坐标系到ENU坐标系的旋转矩阵和平移向量。
5.如权利要求3所述的紧耦合导航方法，其特征在于，根据所述惯性因子残差、视觉因子残差和全局因子残差对所述紧耦合模型进行优化，得到所述水下自主航行器的定位结果，包括：将惯性因子残差、视觉因子残差和全局因子残差合并到一个滑动窗口，得到所述紧耦合模型的代价函数；计算所述滑动窗口时间周期内使所述代价函数最小的状态向量，并将所述计算得到的状态向量作为所述水下自主航行器的定位结果。
6.如权利要求5所述的紧耦合导航方法，其特征在于，所述状态向量为：其中，x k 表示第k时刻对应的IMU的惯性状态信息；n表示滑动窗口时间周期内IMU的惯性状态信息的总数； 表示第一相对位姿； 表示第二相对位姿；λ表示图像特征点的逆深度；m表示滑动窗口时间周期内特征点数量；ρ表示水下自主航行器与应答器的斜距；l表示滑动窗口时间周期内接收到的斜距信息数； 分别表示第k时刻对应的视觉惯性导航系统的位置信息、速度信息和旋转信息；b a ，b g 代表零偏量； 表示视觉惯性导航系统中相机坐标系到载体坐标系的旋转矩阵； 表示视觉惯性导航系统中相机坐标系到载体坐标系的平移向量； 表示视觉惯性导航系统中载体坐标系到ENU坐标系的旋转矩阵； 表示视觉惯性导航系统中载体坐标系到ENU坐标系的平移向量；所述代价函数为：其中， 表示惯性因子残差；r R 表示视觉因子残差；r L 表示全局因子残差； 表示k时刻惯性因子测量值； 表示k时刻视觉因子测量值； 表示k时刻全局因子测量值。
7.一种紧耦合导航系统，该系统基于视觉惯性导航系统和长基线定位系统，其特征在于，应用于水下自主航行器，所述系统包括：局部定位信息获取单元：用于获取视觉惯性导航系统的惯性因子和视觉因子，并分别根据所述惯性因子和视觉因子计算惯性因子残差和视觉因子残差，所述惯性因子包括所述视觉惯性导航系统中IMU的惯性状态信息，所述视觉因子包括图像特征点的逆深度；全局定位信息获取单元：用于获取长基线定位系统的全局因子，根据所述全局因子计算全局因子残差，所述全局因子包括所述水下自主航行器与所述长基线定位系统中应答器的斜距；紧耦合模型构建单元：用于根据所述惯性因子、视觉因子和全局因子构建因子图，并采用基于滑动窗口的紧耦合方式将所述因子图内的惯性因子、视觉因子和全局因子进行融合，构建紧耦合模型；计算优化单元：用于根据所述惯性因子残差、视觉因子残差和全局因子残差对所述紧耦合模型进行优化，得到所述水下自主航行器的定位结果。
8.一种计算机设备，其特征在于：包括存储器、处理器和收发器，它们之间通过总线连接；存储器用于存储一组计算机程序指令和数据，并可以将存储的数据传输给处理器，处理器可以执行存储器存储的程序指令，以执行如权利要求1至6中任一项所述的方法。
9.一种计算机可读存储介质，其特征在于：所述计算机可读存储介质中存储有计算机程序，当所述计算机程序被运行时，实现如权利要求1至6任一项所述的方法。
