Trajectory Tracking for Uncrewed Surface Vessels with Input Saturation and Dynamic Motion Constraints

This paper proposes a nonlinear feedback controller utilizing log-type Barrier Lyapunov Functions to achieve trajectory tracking for uncrewed surface vessels while simultaneously enforcing asymmetric position and heading constraints, symmetric velocity constraints, and input saturation limits, with rigorous stability analysis and simulations confirming that all states remain within prescribed bounds.

The Gist

Imagine you are teaching a very smart, but slightly clumsy, remote-controlled boat to drive itself around a complex course. This boat is an Uncrewed Surface Vessel (USV). It needs to follow a specific path, like a winding river or a figure-eight track, without crashing into the banks, hitting other boats, or breaking its own engine.

This paper is about building the "brain" (the controller) for this boat so it can do that job perfectly, even when things get tricky. Here is the breakdown of the problem and their solution, using some everyday analogies.

The Three Big Problems

The authors identified three main hurdles that make controlling these boats hard:

1. The "Narrow Hallway" Problem (Motion Constraints):
   Imagine trying to walk through a hallway that is constantly changing shape. Sometimes it's a straight, wide corridor (static constraint, like a pond). Other times, it's a twisting, turning river where the walls move closer and farther away as you go (dynamic constraint). If you get too close to the wall, you crash. The boat needs to know exactly how close it can get to the "walls" without hitting them.

2. The "Weak Arms" Problem (Input Saturation):
   The boat has engines (thrusters) to push it forward and turn it. But these engines aren't magic; they have limits. They can't push infinitely hard. It's like trying to run a marathon with a backpack that gets heavier the faster you run. If the boat's brain asks the engines to push harder than they physically can, the boat will spin out of control or fail to follow the path. Most old controllers ignore this and just say, "Push as hard as you can!" which leads to disaster.

3. The "One-Way Street" Problem (Asymmetry):
   This is a subtle but important detail. Imagine a car that has a very powerful engine going forward but a weak brake going backward. Or a boat where the propeller pushes forward easily but struggles to reverse. The limits aren't the same in both directions. Most old systems assume the limits are the same left/right or forward/backward, which isn't true in the real world.

The Solution: The "Invisible Elastic Wall"

The authors created a new control system using something called Barrier Lyapunov Functions (BLFs).

Think of a Barrier Lyapunov Function as an invisible, magical elastic wall surrounding the boat.

• How it works: As the boat gets closer to the "forbidden zone" (the riverbank or the engine limit), this elastic wall gets tighter and tighter.
• The Magic: The closer the boat gets to the limit, the more the "wall" screams "STOP!" mathematically. It forces the boat's brain to slow down or steer away before it actually hits the limit.
• The Result: The boat never actually touches the wall. It glides right up to the edge of safety but never crosses it.

They used two types of these walls:

• Log-type walls: These are great for handling the "Narrow Hallway" problem, especially when the hallway is uneven (asymmetric).
• Smooth Saturation: To handle the "Weak Arms," they didn't just slap a hard "STOP" sign on the engine. Instead, they built a smooth curve that gently tells the engine, "Hey, you're getting close to your limit, let's ease off smoothly." This prevents the boat from jerking around and keeps the engine healthy.

The "Backstepping" Technique

To build this brain, they used a method called Backstepping.

• The Analogy: Imagine you are trying to park a long trailer. You don't just look at the trailer; you look at the hitch, then the truck, then the road. You break the big problem (parking the whole rig) into small, manageable steps.
• In the paper: They first design a plan for where the boat should be (position). Then, they design a plan for how fast it should be moving to get there (velocity). Finally, they design the engine commands (force) to make that happen. They do this step-by-step, ensuring that if the first step is safe, the next step is safe too.

The Results: The Simulation

The authors tested their new brain on a computer simulation of a real ship (the CyberShip II). They made the boat drive in two shapes:

1. An Oval: A simple loop.
2. A Figure-Eight: A much harder, twisting path.

They tested it starting from different spots, sometimes right next to the "walls."

• The Outcome: The boat followed the path perfectly.
• The Safety: It never crashed into the virtual riverbanks.
• The Engine: The engines never tried to push harder than they were allowed to. Even when the boat started far away and had to rush to catch up, the system gently managed the engine power so it didn't break.

Why This Matters

Before this paper, if you wanted a boat to navigate a tight, twisting river, you might have had to program it very conservatively (drive very slowly) to be safe, or risk it crashing if the engines hit their limits.

This new method allows the boat to:

• Drive faster and closer to the edges safely.
• Handle real-world engines that aren't perfectly balanced.
• Navigate changing environments (like a river that curves) without getting confused.

In short, they built a "guardian angel" for the boat that knows exactly how close is too close, ensuring the mission gets done without the boat breaking its own rules or its own body.

Technical Summary

Here is a detailed technical summary of the paper "Trajectory Tracking for Uncrewed Surface Vessels with Input Saturation and Dynamic Motion Constraints."

1. Problem Statement

The paper addresses the trajectory tracking control problem for Uncrewed Surface Vessels (USVs) operating under strict physical and mission-specific limitations. The core challenges identified are:

• State Constraints: USVs must navigate within bounded regions (e.g., narrow rivers, canals, or ponds) without colliding with boundaries. These constraints can be static (fixed boundaries) or dynamic/time-varying (moving boundaries or curvy paths). Crucially, these constraints are often asymmetric (e.g., the distance to the left bank differs from the right bank).
• Input Saturation: Real-world actuators (thrusters) have physical limits on the force/torque they can generate. These limits are often asymmetric (different capabilities in forward vs. reverse thrust). Ignoring these bounds during controller design can lead to instability or severe performance degradation.
• System Complexity: USV dynamics are non-linear, coupled (MIMO system), and influenced by hydrodynamic effects (Coriolis, added mass, damping).
• Gap in Literature: Existing works often assume symmetric constraints, ignore input saturation in the design phase (handling it only as a post-processing block), or fail to address time-varying asymmetric constraints simultaneously.

2. Methodology

The authors propose a nonlinear feedback control strategy based on Backstepping and Barrier Lyapunov Functions (BLFs).

A. System Modeling

• The USV is modeled as a 3-DOF system (surge, sway, yaw) using Earth-fixed and body-fixed frames.
• The dynamics include mass-inertia, Coriolis, and damping matrices, assuming a fully actuated system with known dynamics and no external disturbances (for the baseline design).
• Input Saturation Model: A smooth, differentiable model is introduced to represent asymmetric actuator saturation. Unlike hard saturation blocks, this model uses state variables ($\zeta$) and smooth functions (involving hyperbolic-like terms) to ensure the control demand ($\tau_c$) is processed smoothly while the actual output ($\tau$) respects the asymmetric bounds ($\tau_{min}, \tau_{max}$).

B. Control Design

The control law is derived in three progressive stages:

1. Static Constraints with Input Saturation:

   • Error Definition: Tracking errors are defined for position/heading ($e_1$) and velocities ($e_2$).
   • BLF Selection: An asymmetric log-type Barrier Lyapunov Function is constructed. This function approaches infinity as the error approaches the asymmetric bounds ($k_a, k_b$), effectively preventing constraint violation.
   • Backstepping: A stabilizing function ($\alpha$) is designed for the kinematic loop. A second Lyapunov function is formed for the dynamic loop, incorporating the velocity error.
   • Saturation Handling: A third Lyapunov function is added to account for the actuator saturation dynamics. The control input $\tau_c$ is designed to cancel cross-terms and ensure the derivative of the total Lyapunov function is negative semi-definite ($\dot{V} \leq 0$).

2. Dynamic (Time-Varying) Constraints:

   • The bounds on position and heading are allowed to vary with time ($k_a(t), k_b(t)$).
   • Transformation: To handle time-varying bounds, the error variables are transformed into normalized variables ($\varepsilon$) relative to the time-varying barriers.
   • Adaptive Gains: The control design incorporates time-varying gain terms derived from the derivatives of the boundary functions to ensure stability despite the moving constraints.

3. Dynamic Constraints with Input Saturation:

   • This combines the previous two approaches. The controller simultaneously enforces time-varying asymmetric state constraints and respects asymmetric actuator saturation limits within a unified stability framework.

C. Stability Analysis

• Rigorous Lyapunov stability analysis proves that if the initial conditions satisfy the constraints, all closed-loop signals remain bounded, and the tracking errors converge to zero (or a small neighborhood) without ever violating the prescribed state or input bounds.
• The use of Lemma 1 (invariance of open sets) ensures that the system states never reach the barrier boundaries.

3. Key Contributions

1. Asymmetric State Constraints: The work uniquely addresses asymmetric constraints on position and heading (critical for navigating narrow, curvy channels) alongside symmetric constraints on velocity states.
2. Integrated Asymmetric Input Saturation: Unlike methods that treat saturation as an external block, this design augments the system dynamics with a smooth asymmetric saturation model. This ensures the control demand never exceeds bounds by design, guaranteeing stability and smoother actuator operation.
3. Dynamic Constraint Handling: The proposed scheme handles time-varying constraints (e.g., navigating a winding river) using a transformed error variable approach, which is more general than static constraint methods.
4. Robustness to Initial Conditions: The nonlinear framework allows for large initial deviations, provided they are within the constraint bounds, overcoming limitations of linearized controllers.

4. Simulation Results

The proposed strategies were validated using the CyberShip II model (a 1:70 scale supply ship) through numerical simulations.

• Scenarios:
  • Elliptical and Figure-8 Trajectories: Tested under static and dynamic constraints.
  • Initial Conditions: Multiple starting points (P1, P2, P3) were used, including cases where the USV started very close to the boundary.
  • Constraint Types:
    • Static bounds (fixed pond).
    • Dynamic bounds (time-varying river banks).
    • Asymmetric actuator limits (different max thrust in forward vs. reverse).
• Performance:
  • Tracking: The USV successfully tracked the desired trajectories with errors converging to zero.
  • Constraint Satisfaction: Position and heading errors remained strictly within the asymmetric bounds (never crossing the dashed lines in simulation plots).
  • Actuator Limits: Control inputs ($\tau_u, \tau_v, \tau_r$) remained within the specified asymmetric saturation limits throughout the simulation.
  • Comparison: The results demonstrated that the proposed method avoids the "sharp corners" and potential instability seen in methods that simply clip control inputs after calculation.

5. Significance and Conclusion

This paper presents a significant advancement in marine control by unifying asymmetric state constraints and asymmetric actuator saturation into a single, mathematically rigorous control framework.

• Practical Relevance: Real-world USV operations often involve asymmetric environments (e.g., one-sided river banks) and asymmetric hardware limitations. This controller directly addresses these realities, unlike previous symmetric-only approaches.
• Safety: By guaranteeing that the system never violates physical or mission constraints, the method enhances the safety and reliability of autonomous maritime operations.
• Future Work: The authors note that future research will focus on enhancing robustness against parameter uncertainties (modeling errors) and environmental disturbances (wind, waves, currents), which are currently assumed to be absent or known in the baseline design.

In summary, the proposed BLF-based nonlinear controller offers a robust, stable, and safe solution for USV trajectory tracking in complex, constrained maritime environments.