进阶的科研

Unmanned Surface Vehicles(USV)

1. MMG模型

分离型船舶运动模型（Maneuvering Motion Model for Ships，简称MMG模型）是一种数学模型，用于描述船舶在水中的运动行为和操纵特性。这个模型旨在模拟船舶的运动响应，以便在航海、船舶操纵、自动导航和仿真等领域中进行研究和应用。

MMG模型通常包括以下几个关键方面的参数和子模型：

1. 静力稳定性：这部分模型考虑了船舶在平稳状态下的受力和力矩平衡，包括浮力、重力和浸入的变化。这有助于描述船舶的平稳漂浮状态。

   船舶在平稳状态下的受力和力矩平衡是描述船舶静力稳定性的重要方面。在平稳状态下，船舶既不加速也不旋转，因此各个受力和力矩之间必须达到平衡，以维持其当前状态。以下是描述船舶在平稳状态下受力和力矩平衡的基本原理：

   1. 浮力与重力平衡：在平稳状态下，船舶所受的浮力（Buoyant Force）必须与其所受的重力（Gravity Force）平衡。浮力是由于船舶在水中部分或完全浸没而产生的，其大小等于被排斥水的重量。重力则是由于船舶的质量而产生的，其大小等于船舶的质量乘以地球上的重力加速度（通常为9.81 m/s²）。

   *浮力 = 重力*

   2. 推进力与阻力平衡：如果船舶在平稳状态下航行，那么所受的推进力（Propulsive Force）必须与所受的水动力阻力（Hydrodynamic Resistance）平衡。推进力是由船舶的推进装置（通常是螺旋桨）提供的，用于推动船舶前进。水动力阻力是船舶在水中运动时所面临的阻力，它包括摩擦阻力和波浪阻力等。

   *推进力 = 水动力阻力*

   3. 动力与反作用力平衡：根据牛顿第三定律，船舶的推进力必须与产生该推进力的反作用力平衡。这意味着如果船舶在一个方向上受到推进力，它将在相反方向上受到一个等大但方向相反的反作用力。

   *推进力 = 反作用力*

   4. 舵力与转向力矩平衡（如果适用）：如果船舶需要改变方向，舵的操作将产生一个舵力（Rudder Force），以及一个与之相对应的转向力矩（Yawing Moment）。这个转向力矩必须与任何其他力矩平衡，以保持平稳状态。

   *舵力 = 其他力矩引起的力矩*

   综上所述，船舶在平稳状态下的受力和力矩平衡是一个复杂的静力学问题，需要考虑多个因素，包括船舶的形状、质量分布、浸没情况、速度等。确保这些力和力矩之间的平衡非常重要，以维持船舶的稳定状态，防止倾覆或其他不稳定的情况发生。这也是船舶设计和运营中的关键考虑因素。

2. 动力学模型：这一部分考虑了船舶的加速度和速度响应。它通常包括了船舶的质量和惯性特性，以及操纵装置（如舵）的影响。动力学模型描述了船舶如何响应不同类型的操纵输入。

   船舶的惯性特性是指船舶在运动和操纵时对外部力和力矩的响应速度和程度，通常包括质心位置、质量分布、质量惯性矩、质心高度等参数。这些特性对于船舶的稳定性、操纵性和性能有着重要影响。以下是一些船舶的惯性特性的重要参数：

   1. 质心位置（Center of Gravity，CoG）：质心是船舶的质量集中点，通常以长、宽、高坐标系中的坐标表示。质心位置的高度和水平位置对于船舶的稳定性至关重要。较低的质心有助于提高稳定性。
   2. 质心高度（Metacentric Height，GM）：GM是一个衡量船舶稳定性的关键参数，它是船舶的重力中心与浮力中心之间的垂直距离。较大的GM值通常表示较好的稳定性。

3. 横向稳定性：这一部分关注船舶在横向方向上的稳定性，包括侧倾稳定性和横摇稳定性。这些特性影响了船舶的侧向运动和稳定性。

   船舶的侧倾稳定性和横摇稳定性是两个关键的稳定性概念，涉及到船舶在侧向运动和横摇运动时的稳定性表现。以下是关于这两种稳定性的详细解释：

   1. 侧倾稳定性（Heeling Stability）：
      • 定义：侧倾稳定性是指船舶在侧向运动（侧倾或倾斜）时的稳定性。当船舶受到外部力或力矩作用，试图将其倾斜至一侧时，侧倾稳定性决定了船舶是否会自动回复到垂直位置。
      • 稳定性表现：较好的侧倾稳定性意味着船舶倾斜后具有回复到垂直位置的趋势。这通常是通过具有低质心、宽船体、稳定的船体形状以及压载水线的设计来实现的。
      • 影响因素：侧倾稳定性受到质心高度、重力中心位置、船体形状、防侧倾设备（如侧装舱）等因素的影响。
   2. 横摇稳定性（Roll Stability）：
      • 定义：横摇稳定性是指船舶在横摇运动（摇晃或左右摆动）时的稳定性。当船舶受到外部力或力矩作用，试图将其摇晃时，横摇稳定性决定了船舶是否会自动回复到稳定的状态。
      • 稳定性表现：较好的横摇稳定性意味着船舶在摇晃后具有回复到平稳状态的趋势。这通常是通过合适的质心高度、质量分布、船体形状以及稳定装置（如阻尼舱或抗横摇翼）来实现的。
      • 影响因素：横摇稳定性受到质心高度、质量分布、船体宽度、阻尼装置、风力、海浪等多种因素的影响。

   总的来说，侧倾稳定性和横摇稳定性都是关于船舶的稳定性和安全性非常重要的概念。合理的设计和操作可以确保船舶在侧向运动或横摇运动中具有良好的稳定性，减少事故和危险。船舶设计师和船舶操作员需要密切关注这些稳定性因素，并采取适当的措施来维护和提高船舶的稳定性。

4. 纵向稳定性：这一部分关注船舶在纵向方向上的稳定性，包括纵倾稳定性和纵摇稳定性。这些特性影响了船舶的前后运动和稳定性。

   船舶的纵倾稳定性和纵摇稳定性是两个重要的稳定性概念，涉及到船舶在纵向运动中的稳定性表现。以下是这两种稳定性的详细解释：

   1. 纵倾稳定性（Pitch Stability）：
      • 定义：纵倾稳定性是指船舶在纵向运动中的稳定性。当船舶受到外部力或力矩作用，试图使其在前后倾斜时，纵倾稳定性决定了船舶是否会自动回复到水平状态。
      • 稳定性表现：较好的纵倾稳定性意味着船舶在前后倾斜后具有回复到水平状态的趋势。这通常是通过合适的质心高度、重力中心位置、船体形状、舵的设置等因素来实现的。
      • 影响因素：纵倾稳定性受到质心高度、船体形状、船舶速度、纵向稳定装置（如配重、水密舱）等因素的影响。
   2. 纵摇稳定性（Yaw Stability）：
      • 定义：纵摇稳定性是指船舶在纵向运动中的稳定性，特别是与船舶的偏航运动有关。当船舶受到外部力或力矩作用，试图使其旋转或偏航时，纵摇稳定性决定了船舶是否会自动回复到直线行驶状态。
      • 稳定性表现：较好的纵摇稳定性意味着船舶在发生偏航运动后具有回复到直线行驶状态的趋势。这通常是通过合适的船舶外形设计、舵的设置、自动操纵系统等因素来实现的。
      • 影响因素：纵摇稳定性受到船舶外形、船首和船尾的形状、舵的设计和操作、风力和海浪等因素的影响。

   纵倾稳定性和纵摇稳定性都是关键的船舶稳定性特性，对船舶的安全性和操纵性具有重要影响。合理的设计和操作可以确保船舶在纵向运动中具有良好的稳定性，减少事故和危险。船舶设计师和船舶操作员需要密切关注这些稳定性因素，并采取适当的措施来维护和提高船舶的稳定性。

5. 融合模型：最终，MMG模型将这些不同的子模型融合在一起，以模拟整个船舶的运动响应。这可以通过微分方程或其他数学方法来实现。

MMG模型的精度和复杂程度可以根据具体应用的需要进行调整。这种模型在船舶设计、航海训练、自动驾驶系统开发以及海事仿真等领域都具有广泛的应用。通过模拟船舶的运动行为，研究人员和工程师可以更好地了解船舶在不同条件下的性能，并开发出更安全和高效的船舶操作和控制方法。

2. USV旋转角

USV的旋转矩阵通常用来描述其姿态（航向、俯仰和横滚）的变化。USV的姿态通常由旋转矩阵、四元数或欧拉角等方式表示。这里，我将为你提供一个描述USV姿态的旋转矩阵的简单示例。

USV的姿态通常使用一个3x3的旋转矩阵R来表示，这个矩阵描述了USV坐标系与世界坐标系之间的旋转关系。矩阵的元素可以表示如下：

R = |  R11  R12  R13  |
    |  R21  R22  R23  |
    |  R31  R32  R33  |

其中，R11、R12、R13表示USV坐标系的x轴在世界坐标系中的方向；R21、R22、R23表示y轴的方向；R31、R32、R33表示z轴的方向。

如果你有USV的欧拉角（Yaw、Pitch、Roll），你可以使用以下方法构建旋转矩阵：

1. 计算Yaw、Pitch、Roll的弧度值。
2. 构建绕z轴（Yaw）、y轴（Pitch）、x轴（Roll）的旋转矩阵。
3. 将这些旋转矩阵相乘以获得最终的旋转矩阵。

具体的数学计算可能需要根据你的USV的坐标系约定和数学库来进行调整，但这个基本思路可以帮助你构建无USV的旋转矩阵。

需要注意的是，USV的姿态控制是一个复杂的问题，涉及到传感器测量、控制算法等多个因素。实际应用中，你可能需要使用专门的USV控制库或工具来处理姿态信息。

3. USV的运动和姿态相关概念

1. 纵向位移、横向位移和艏摇角度

   • 纵向位移：纵向位移指船舶在前后方向上相对于其平衡位置的移动，即船头向前或向后的移动距离。正值表示船头向前移动，负值表示船头向后移动。
   • 横向位移：横向位移指船舶在左右方向上相对于其平衡位置的移动，即船舶侧向的移动距离。正值表示船舶向右移动，负值表示船舶向左移动。
   • 艏摇角度：艏摇角度表示船舶的艏部相对于其平衡位置的偏航角度。正值表示船舶艏部朝向右侧，负值表示朝向左侧。

   这三个概念描述了船舶相对于其平衡位置的位移和姿态变化。

2. 纵荡运动、横荡运动和艏摇运动

   • 纵荡运动：纵荡运动是指船舶在前进和后退方向上的周期性运动，即船头在前后摆动的运动。
   • 横荡运动：横荡运动是指船舶在左右方向上的周期性运动，即船体在左右摆动的运动。
   • 艏摇运动：艏摇运动是指船舶艏部（前部）相对于水平面的偏航运动，描述了船头在水平面上的摆动。

   这三个概念描述了船舶在水中运动时可能发生的周期性运动。

总的来说， _纵向位移、横向位移和艏摇角度_ 描述了船舶的位移和姿态变化，而 _纵荡运动、横荡运动和艏摇运动_ 描述了船舶在水中运动时可能发生的周期性运动方式。这两组概念描述了船舶运动和姿态的不同方面。

4. 惯性质量矩阵（Inertia Matrix）

船舶的惯性质量矩阵（Inertia Matrix）是描述船舶在运动和旋转过程中对惯性力和惯性力矩的响应的重要概念。这个矩阵包含了关于船舶的质量分布和转动惯量的信息，对于分析船舶的运动和稳定性非常重要。

惯性质量矩阵通常表示为一个3 X 3 的矩阵，包含以下元素：

1. 质量（Mass）：

   • 在对角线上，通常有三个元素，分别是船舶绕三个坐标轴的质量：纵向轴（X轴）、横向轴（Y轴）和垂直轴（Z轴的质量）。
   • 这些元素代表了船舶在运动时的质量分布，通常以吨（或其他适当的质量单位）表示。

2. 横滚惯性矩量（Rolling Moment of Inertia）：

   • 这是描述船舶绕横向轴（Y轴）旋转的性质。
   • 它反映了船舶在横滚运动时的抵抗程度，通常以吨米²表示。
     PS:吨米²是一个表示物体惯性矩量的单位。表示的是质量和长度单位的组合，用于描述物体对绕特定轴旋转的惯性矩量。在船舶动力学和物理学中，这个单位通常用于描述船舶或其他物体在不同轴上的转动惯性。

3. 纵倾惯性矩量（Pitching Moment Inertia）：

   • 这是描述船舶绕纵向轴（Y轴）旋转的性质。
   • 它反映了船舶在纵倾运动时的抵抗程度，通常以吨米²表示。

4. 艏摇惯性矩量（Yawing Moment of Inertia）：

   • 这是描述船舶绕垂直轴（Z轴）旋转的性质。
   • 它反映了船舶在艏摇运动时的抵抗程度，通常以吨米²表示。

这个矩阵的具体数值由船舶的设计和几何特性以及质量分布决定。它对于分析船舶的稳定性、响应以及控制系统的设计都非常重要。通常，惯性质量矩阵会在船舶设计和模拟中用于预测船舶在不同条件下的运动行为。

5. 科里奥利向心力矩阵（Corioliscentripetal matrix）

船舶的科里奥利向心力矩阵是用于描述船舶在运动中受到科里奥利力（Coriolis Force）或向心力（Centripetal Force）的影响的矩阵。科里奥利力是一种由于物体在旋转坐标系中运动而产生的力，它会影响物体的运动轨迹，特别是在地球上的运动。

在船舶动力学中，科里奥利向心力矩阵通常是一个复杂的矩阵，用于描述船舶在不同运动状态下受到科里奥利力矩的影响。这个矩阵的具体形式会受到船舶的运动特性和坐标系定义的影响。

科里奥利力和向心力的作用可以影响船舶的运动，尤其是在船舶进行曲线运动、转弯或变速运动时。这些力会导致船舶发生横向偏转和旋转运动，因此在船舶动力学和控制系统设计中，科里奥利向心力矩阵是一个重要的概念。

具体的科里奥利向心力矩阵的计算和表达通常需要考虑船舶的运动状态、速度、坐标系以及物体相对于地球旋转的影响。这需要复杂的数学建模和分析，通常在船舶动力学研究和控制系统设计中使用。这个矩阵的形式和数学表达可能因船舶类型和问题而异。

6. 阻尼矩阵（damping matrix）

船舶的阻尼矩阵是一个用于描述船舶在运动中受到的阻尼力影响的矩阵。阻尼力是指障碍船舶在水中运动时产生的速度和姿态变化的力，它通常与船舶的流体动力学特性和水动力特性有关。

阻尼矩阵是一个关于船舶运动状态和速度的函数，通常以矩阵的形式表示，用于描述不同运动状态下的阻尼效应。具体来说，阻尼矩阵包含了以下信息：

1. 线性速度阻尼（Linear Velocity Damping）：这包括船舶在纵向、横向和垂直方向上的线性速度阻尼，即船舶在不同方向上的线性速度变化所受到的阻尼力影响。
2. 角速度阻尼（Angular Velocity Damping）：这包括船舶绕纵向、横向和垂直轴的角速度阻尼，即船舶在不同轴上的角速度变化所受到的阻尼力影响。

阻尼矩阵的具体数值收到船舶的几何形状、流体动力学特性、表面粗糙度以及船舶在水中的速度等多种因素的影响。通常，为了得到阻尼矩阵的数值，需要进行复杂的水动力实验或者数值模拟。

阻尼矩阵在船舶动力学和控制系统设计中起到重要作用，因为它影响着船舶的运动响应和稳定性。通过考虑阻尼矩阵，可以更好地了解船舶在不同状态下的动态行为，以便进行航行控制，操作和船舶设计方面的优化。

7. USV的PD控制器

USV的PD控制器是一种用于控制USV姿态和位置的控制器。USV通常需要在水中精确控制其姿态（如横摇、纵荡、艏摇等）和位置（如横向位移、纵向位移）以完成各种任务，例如海洋勘测、水下探测、货物运输等。

以下是USV的PD控制器的一般步骤和要点：

1. 定义控制目标：首先，需要明确定义USV的控制目标，包括期望的姿态和位置。这些目标通常由任务需求和导航任务决定。
2. 姿态控制：PD控制器通常用于姿态控制，以确保USV保持期望的姿态。姿态通常包括横摇、纵荡和艏摇。对于每个姿态，您需要定义期望姿态和当前姿态之间的误差。
3. 位置控制：PD控制器也可用于位置控制，以确保USV达到期望的位置。位置通常包括横向位移和纵向位移。对于每个位置，您需要定义期望位置和当前位置之间的误差。
4. 编写PD控制器：根据姿态和位置误差，编写PD控制器的控制算法。控制输出通常是USV需要采取的行动，例如舵角或推进力的调整。
5. 调整PD参数：PD控制器的性能通常受到比例增益（Kp）和微分增益（Kd）的影响。根据实际系统的响应，需要进行参数调整，以使控制系统稳定且具有所需的性能。
6. 实时控制：USV通常配备传感器来测量当前的姿态和位置。PD控制器会根据传感器数据实时计算控制输出，并将其应用于USV的执行器，例如舵或推进器。
7. 反馈控制：PD控制器通过不断反馈和调整控制输出，使USV保持在期望的姿态和位置。这个过程在船舶运动中不断迭代，以响应外部扰动和任务需求。

PD控制器是一种常见的控制策略，用于实现USV的精确姿态和位置控制。但要注意，实际应用中可能需要更复杂的控制策略和方法，以应对不同的任务和环境条件。因此，控制器的设计和参数调整通常需要根据具体应用进行定制。

8. USV的VO

USV的VO是一种用于USV避免与其他物体碰撞的方法。它借鉴了VO的原理，但针对水上环境和船舶特定需求进行了定制化。

以下是USV的VO的关键要点：

1. 感知和预测：首先，USV需要具备感知和预测其他物体的能力。这通常通过传感器系统（如雷达、摄像头、LIDAR等）来实现，以获取周围环境的信息。同时，需要根据其他物体的运动状态和轨迹预测模型来估计其他物体未来的位置和速度。
2. 速度空间：速度障碍区域通常定义在速度空间中，这个空间包括USV的速度向量以及其他物体的速度向量。在二维情况下，速度空间通常包括USV的水平速度和垂直速度，以及其他物体的水平速度和垂直速度。在三维情况下，还需要考虑垂直方向的速度。
   
   PS:垂直速度通常指的是垂直于重力方向的速度，而垂直方向速度则可以相对于任何垂直方向来定义，具体取决于上下文和参考坐标系的选择。因此，在具体应用中，需要根据上下文和参考坐标系来理解这两个术语。
3. 计算碰撞检测：在速度空间中，通过计算USV的速度向量与其他物体的速度向量之间的关系，可以确定可能导致碰撞的速度组合，这通常涉及一下计算：

   • 计算速度向量之间的相对速度。
   • 计算碰撞时间：即在哪个时间点，两个物体的最近距离达到最小值。
   • 确定碰撞时间下两个物体的位置。

4. 速度障碍区域的计算：一旦计算出碰撞检测，可以将这些信息用于构建速度障碍区域。速度障碍区域包括USV可能的速度组合，通常以多边形或集合的形式表示，这些速度组合会导致在碰撞时间点附近与其他物体相撞。
5. 自适应速度调整：如果当前USV的速度位于速度障碍区域内，那么速度障碍法会触发自适应速度调整。这意味着USV需要选择一个可行速度，以避免与其他物体碰撞。这个可行速度通常是速度障碍区域内的一个安全区域。
6. 路径规划：一旦选择了可行速度，USV会使用路径规划算法来确定如何调整速度以避开障碍物。这可能涉及到修改航线或路径，以确保USV在考虑到速度障碍区域后仍然能够到达目标。
7. 实时控制：速度调整和路径规划是在实时中进行的，以持续检测和响应周围环境的变化。USV的控制系统需要能够快速适应新的情况，以确保安全导航。

USV的VO是一种关键的碰撞避免策略，可用于各种水上任务，如海洋勘测、巡逻、救援操作等。通过结合感知、预测、速递障碍区域计算和路径规划，USV可以在复杂的水上环境中自主、安全地导航，避免与其他船只或障碍物发生碰撞。