Pith. sign in

REVIEW 4 major objections 5 minor 27 references

Risk-Aware Trajectory Optimization and Control for an Underwater Suspended Robotic System

T0 review · 4 major / 5 minor · reviewed 2026-08-06 · deepseek-v4-flash

Challenge this review Re-run · record.json Download PDF Read on arXiv ↗

Pith's one-line read The paper claims that adding a local feedback loop to risk-aware trajectory optimization makes an underwater litter-collection system safer and more energy-efficient under parameter uncertainty.

desk verdict A plausible feedback-augmented SAA method for a fresh USV-UUV model, but the simulation evidence is undercut by a sign-reversed collision metric and an incorrect drag model. read the letter →

arxiv 2507.04640 v1 pith:L3EFQYO5 submitted 2025-07-07 eess.SY cs.SY

Yuki Origane , Nicolas Hoischen , Tzu-Yuan Huang , Daisuke Kurabayashi , Stefan Sosnowski , Sandra Hirche This is my paper · ORCID
classification eess.SYcs.SY
keywords unmannedunderwatervehiclessurfacetrajectoryoptimizationuncertaintycollisionavoidancerisk-awarecontrolstochasticoptimal
verification ladder T0 review T1 audit T2 compute T3 formal

The pith

A machine-rendered reading of the paper's core claim, the machinery that carries it, and where it could break.

The reading

This paper studies an uncrewed surface vessel (USV) winching an uncrewed underwater vehicle (UUV) that picks up litter, where the litter's mass and drag make the system's parameters uncertain. The authors build a planar three-degree-of-freedom model of the coupled USV-tether-UUV system and formulate the navigation task as a stochastic optimal control problem with a conditional value-at-risk (CVaR) constraint on collision avoidance. Their contribution is a planner, RA-SAA+FB, that wraps a local feedback controller around a risk-aware sample average approximation (SAA) optimizer, keeping sampled uncertain trajectories close to a nominal trajectory. In Monte Carlo simulations with up to 50% parameter uncertainty, the method yields lower collision rates, lower input energy, and better target convergence than the RA-SAA, A*+PID+CBF, and MPPI baselines. The paper argues this makes the safety guarantees of risk-aware planning compatible with the inevitable parameter uncertainty of picking up unknown litter.

What carries the argument

The carrying mechanism is the feedback-augmented closed-loop controller inside the SAA: a control law of the form $\mu(x_i,t) = \mathrm{sat}(u(t) + K(x_{\mathrm{nom}}^u(t) - x_i(t)))$, where the nominal trajectory $x_{\mathrm{nom}}^u$ is generated with the expected parameter values, $K$ is a fixed PD gain, and the saturation keeps inputs in the feasible set. Inside the optimization, sampled trajectories are simulated with this controller, so the CVaR collision-avoidance constraint is evaluated on trajectories that stay tightly centered around the nominal path instead of fanning out under large parameter uncertainty. This tightness keeps the terminal target constraint feasible and reduces the conservativeness of the risk constraint, while the outer loop still optimizes the feedforward plan $u$, preserving the convergence properties of the CVaR-SAA method the paper builds on.

What would settle it

Measure the USV's actual acceleration while the UUV drags a heavy load through a winch and tether, and compare it with the decoupled prediction $M \ddot{X} = -\eta_X(\dot{X}) + f_X$; if the deviation exceeds the process-noise level, the model's central assumption is false and the reported collision and energy improvements should be re-computed with coupled dynamics.

Watch

Extended reading notes

Core claim

The central claim is that planning over closed-loop trajectories rather than open-loop inputs is what makes risk-aware trajectory optimization practical for a tethered UUV-USV litter collector. The paper derives a dynamical model from Euler-Lagrange equations in polar coordinates, treating the tether as taut and massless, the USV as decoupled from tether forces, and the UUV as a point mass with uncertain weight and drag. It then formulates the planning problem as a CVaR-constrained stochastic optimal control problem and solves it with a feedback-augmented sample average approximation, where each sampled trajectory is controlled by a fixed-gain PD feedback toward the nominal trajectory while the optimized feedforward plan is common to all samples. The paper claims this preserves the asymptotic optimality guarantees of the original SAA formulation, and in simulation it reports statistically significant gains in collision avoidance and energy efficiency over the three baselines under parameter uncertainty.

Load-bearing premise

The load-bearing premise is that the USV's propeller force is strong enough that the tether's pull on the USV can be ignored; if tether tension is significant, as it is when lifting heavy litter, the USV's motion is coupled to the UUV's, and the simulated benefits may not carry over to the real system.

Editorial extensions

If this is right

  • As parameter uncertainty grows, the collision rate of RA-SAA+FB stays near zero, while the open-loop RA-SAA and MPPI baselines degrade.
  • Input energy for RA-SAA+FB is the same or lower than the named baselines across all tested uncertainty levels.
  • The final position error remains small even at 50% parameter uncertainty, because the feedback keeps sampled trajectories near the nominal path and the terminal constraint feasible.
  • The same feedforward plan can be run at lower frequency online, since the local feedback controller handles deviations between optimization updates at a higher rate.

Reading between the lines

Editorial extensions of the paper, not claims the author makes directly.

  • Editorial inference: treating the feedback gain $K$ as a decision variable of the optimization, rather than a hand-set PD gain, could produce a principled trade-off between trajectory tightness and control effort, and would test how sensitive the reported gains are to the gain value.
  • Editorial inference: the same feedback-augmented CVaR-SAA scheme should transfer to other tethered marine tasks, such as subsea inspection or cable-guided intervention, where the same drag and weight uncertainty appears.
  • Editorial inference: since the simulations randomize system parameters uniformly while real estimation errors are often Gaussian, re-running the study with a Gaussian disturbance model would show whether the collision and energy advantages persist when large deviations are rarer but bounded.
Share X Bluesky LinkedIn Reddit HN

Editorial analysis

A structured set of objections, weighed in public.

Desk editor's note, referee report, and a circularity audit.

Referee Report

4 major / 5 minor

Summary. The paper models a taut-tethered USV-UUV system in the vertical plane, derives the dynamics via Euler–Lagrange equations, and formulates a risk-aware stochastic optimal control problem with CVaR constraints and sample average approximation. It proposes an extension, RA-SAA+FB, that adds a fixed-gain PD feedback term around the nominal trajectory, and evaluates the method in simulation against RA-SAA, A*+PID+CBF, and MPPI. The stated contributions are the dynamical model, the closed-loop extension of RA-SAA, and simulation evidence that the proposed method reduces collision risk and energy consumption under parameter uncertainty.

Significance. The system being modeled is relevant and has not been treated in this taut-tether configuration before, so a validated planar model and a risk-aware control extension would be of interest to the marine robotics and stochastic optimal control communities. The idea of centering sampled trajectories around a nominal one with a local feedback controller is a sensible and potentially practical enhancement of RA-SAA, and the Monte Carlo comparison against three external baselines is a reasonable, non-circular evaluation strategy. However, the manuscript as written contains a sign-reversed collision metric and a sign error in the drag model, both of which affect the main empirical claims. A quantitative treatment of the tether-reaction assumption is also missing. With corrections to those points, the paper could make a solid contribution, but the current numerical evidence is not trustworthy.

major comments (4)
  1. [Section 4.2, collision rate definition] The collision flag is defined as 1 whenever min_t(−‖y(t)−yO‖² + aO²) < 0. Since safe trajectories satisfy ‖y(t)−yO‖ > aO, the quantity −‖y(t)−yO‖² + aO² is negative at the start and during all safe motion, so the minimum is always negative and the flag is 1 for every trajectory that begins outside the obstacle. A penetration makes the expression positive only while the trajectory is inside the obstacle, but the minimum over the entire interval is taken at the starting point, so the stated formula cannot detect collisions either. Figure 4b reports collision rates well below 1 and differences among methods, which is inconsistent with this definition. The optimization constraint in Eq. (23) uses max_k(aO − ‖(x,d)−(xO,dO)‖) ≤ 0 as the safe condition, so the metric should be based on max_t(aO − dist) > 0 or equivalently min_t(dist − aO) < 0. Until the formula is corrected and the simulations are rerun, the headline claim that RA-SAA+FB reduces collision risk is unsupported.
  2. [Section 2.1, Eqs. (12)–(13)] The drag model has a sign error in the relative-velocity components. From the coordinate transformation (4)–(5), the UUV velocity relative to stationary water along the radial and tangential directions is \dot r − \dot X sin θ and r\dot θ − \dot X cos θ, respectively. The expressions \dot X sin θ + \dot r and \dot X cos θ + r\dot θ in Eqs. (12)–(13) therefore have the wrong sign on the \dot X terms. Because this drag model is the one simulated for all methods, the error changes every quantitative result in Section 4, including the comparisons in Figure 4. The equations must be corrected and the simulations repeated before the empirical claims can be assessed.
  3. [Section 2.1, Eq. (1) and Eq. (9)] The assumption that the USV propeller is strong enough to ignore the reaction force from the tether decouples the USV dynamics as M \ddot X = −η_X + f_X. This is a load-bearing modeling premise for the heavy-lifting scenario, where tether tension is expected to be significant, but no quantitative justification or sensitivity analysis is provided. A concrete test would be to compare the proposed model with one that includes the horizontal component of the tether tension in the X dynamics, or to report typical tension magnitudes obtained from the optimized trajectories. Without such evidence, it is unclear whether the simulation results transfer to the physical system.
  4. [End of Section 3.2, convergence claim] The text states that "the same asymptotic optimality results can be derived as in (Lew et al., 2023)" for the modified problem SOCP+FB, which includes a fixed feedback gain, a saturation function, and a time-discretized implementation. This is a load-bearing claim about the method's guarantees, but no proof or precise adaptation of the assumptions (A1)–(A4) to this closed-loop problem is given. The authors should either provide the derivation or explicitly mark this as a conjecture/limitation rather than asserting it as a proven property.
minor comments (5)
  1. [Sections 2.1–2.2] The symbol x is used both for the horizontal coordinate and for the full state vector (q, \dot q, f), which makes equations such as (23) difficult to read; a distinct symbol for the full state would improve clarity.
  2. [Section 4.2] The metric uses ‖y(t)−yO‖ with y=(x,d,X), but the obstacles are defined only in (x,d) coordinates; the paper should specify how yO is embedded in the three-dimensional output space or restrict the metric to the UUV coordinates.
  3. [Eq. (20c)] Since H(x) is a squared distance, it is nonnegative and the lower inequality −δ_M ≤ (1/N)Σ_i H(x_i(t_f)) is redundant; if the intent is to bound the absolute terminal error, the constraint should be written as an absolute value or as an upper bound only.
  4. [Section 1, Paper Organization] The acronym "RAA-SAA" in the organization paragraph appears to be a typo for "RA-SAA".
  5. [Eq. (21)] The use of ellipses inside the vector defining the uncertain parameter ξ is notationally unclear; using explicit indices for the obstacle parameters would make the mapping to Eq. (23) more transparent.

Circularity Check

0 steps flagged · score 0.0 of 10

No significant circularity: the trajectory-optimization claim is benchmarked against external baselines and the convergence guarantee is inherited from external prior work.

full rationale

The paper's derivation chain is self-contained and non-circular. The coupled UUV-USV model is derived from a Lagrangian and Euler-Lagrange equations (Section 2.1), with no fitted constants targeting a claimed outcome. The central empirical comparison (Section 4) evaluates RA-SAA+FB against independent baselines (RA-SAA, A*+PID+CBF, MPPI) using metrics for final position error, collision rate, and input energy; no parameter is fitted to make the proposed method win, and the feedback gain K is selected as a fixed PD gain, not tuned to the reported results. The asymptotic optimality claim is explicitly inherited from Lew et al. (2023), an external, previously published result; the paper does not invoke a self-citation chain to justify its novelty. The only notable weakness is internal rather than circular: the collision metric in Section 4.2 defines rho_collision_ij = 1 when min_t (-||y(t)-yO||^2 + aO^2) < 0, which is negative for every safe trajectory, so Figure 4b cannot literally support the stated collision-rate comparison. This is a consistency/evaluation defect, not a circularity of the derivation, and it does not make any prediction equivalent to an input by construction. Accordingly, the circularity score is 0.

Assumptions & free parameters 1 free parameters · 5 assumptions · 0 invented entities

The central simulation results rest on the taut-tether planar model, the decoupling of the USV from tether forces, known uncertainty distributions, and the transfer of SAA convergence guarantees from Lew et al. (2023). The feedback gains KP and KD are hand-chosen. No new physical entities are introduced.

free parameters (1)
  • Feedback gain matrices KP and KD = KP = 800*I4, KD = 80*I4
    Chosen by hand in Table 2 to define the feedback law in (18); simulation results depend on this choice.
assumptions (5)
  • domain assumption Taut, massless tether with l = r
    Section 2.1, used to derive Eq (9); ignores cable bending and tether inertia.
  • domain assumption USV reaction force from tether is negligible
    Section 2.1, first bullet; decouples USV dynamics in Eq (1).
  • domain assumption UUV is a point mass; no currents or waves
    Section 2.1, third bullet; simplifies kinetic and potential energy in Eq (3).
  • domain assumption Known probability distributions for uncertain parameters
    Assumption 2 in Section 2.2; required to formulate the CVaR constraints in (16).
  • standard math Lipschitz continuity and boundedness of dynamics, cost, and constraint functions
    Invoked in Section 3.2 to transfer asymptotic optimality from Lew et al. (2023).

how reviews work

0 comments
Cite this review

Pith. "Pith review of Risk-Aware Trajectory Optimization and Control for an Underwater Suspended Robotic System." pith.science (2026). https://pith.science/paper/L3EFQYO5

@misc{pith2026250704640,
  author       = {Pith},
  title        = {Pith review of: Risk-Aware Trajectory Optimization and Control for an Underwater Suspended Robotic System},
  year         = {2026},
  howpublished = {\url{https://pith.science/paper/L3EFQYO5}},
  note         = {Machine review of arXiv:2507.04640}
}
read the original abstract

This paper focuses on the trajectory optimization of an underwater suspended robotic system comprising an uncrewed surface vessel (USV) and an uncrewed underwater vehicle (UUV) for autonomous litter collection. The key challenge lies in the significant uncertainty in drag and weight parameters introduced by the collected litter. We propose a dynamical model for the coupled UUV-USV system in the primary plane of motion and a risk-aware optimization approach incorporating parameter uncertainty and noise to ensure safe interactions with the environment. A stochastic optimization problem is solved using a conditional value-at-risk framework. Simulations demonstrate that our approach reduces collision risks and energy consumption, highlighting its reliability compared to existing control methods.

Figures

Figures reproduced from arXiv: 2507.04640 by the authors.

Figure 1
Figure 1. SeaClear USV-UUV System with the Seacat 2.0 from Subsea Tech. A more integrated ap￾proach, however, formu￾lates a single optimization problem that incorporates prior knowledge of the robot’s dynamics and envi￾ronment. Enforcing safety within this problem leads to three main paradigms (Akella et al., 2024). The worst-case paradigm pri￾oritizes safety by ensur￾ing constraints hold un￾der any disturbance, but is often … view at source ↗
Figure 2
Figure 2. Model of suspended UUV and USV only three degrees of freedom. The model is illustrated in [PITH_FULL_IMAGE:figures/full_fig_p002_2.png] view at source ↗
Figure 3
Figure 3. Overview of the RA-SAA+FB method. The bracket [0 : [PITH_FULL_IMAGE:figures/full_fig_p005_3.png] view at source ↗
Figures from the paper (2 more)
Figure 4
Figure 4. Figure 4: Evaluation of metrics from the simulation results [PITH_FULL_IMAGE:figures/full_fig_p007_4.png]
Figure 5
Figure 5. Figure 5: Comparison of trajectories for i = 81. and drag uncertainties across different sampled scenarios. The paths exhibit a natural pendulum-like motion, in￾dicating that the optimization correctly aligns with the system’s inherent dynamics. In contrast, the original RA￾SAA …

Discussion (0). Continue with ORCID to comment.

Reference graph

Works this paper leans on

27 extracted references · 23 canonical work pages

  1. [1]

    , " * write output.state after.block = add.period write newline

    ENTRY address author booktitle chapter doi edition editor eid howpublished institution journal key month note number organization pages publisher school series title type url volume year label extra.label sort.label short.list INTEGERS output.state before.all mid.sentence after.sentence after.block FUNCTION init.state.consts #0 'before.all := #1 'mid.sent...

  2. [2]

    write newline

    " write newline "" before.all 'output.state := FUNCTION n.dashify 't := "" t empty not t #1 #1 substring "-" = t #1 #2 substring "--" = not "--" * t #2 global.max substring 't := t #1 #1 substring "-" = "-" * t #2 global.max substring 't := while if t #1 #1 substring * t #2 global.max substring 't := if while FUNCTION word.in bbl.in capitalize " " * FUNCT...

  3. [3]

    Akella, P., Dixit, A., Ahmadi, M., Lindemann, L., Chapman, M.P., Pappas, G.J., Ames, A.D., and Burdick, J.W. (2024). Risk-aware robotics: Tail risk measures in planning, control, and verification. arXiv preprint arXiv:2403.18972

    work page Pith review arXiv 2024

  4. [4]

    Ames, A.D., Xu, X., Grizzle, J.W., and Tabuada, P. (2017). Control barrier function based quadratic programs for safety critical systems. IEEE Transactions on Automatic Control, 62(8), 3861--3876. doi:10.1109/TAC.2016.2638961

    arXiv 2017

  5. [5]

    Bansal, S., Chen, M., Herbert, S., and Tomlin, C.J. (2017). Hamilton-jacobi reachability: A brief overview and recent advances. In 2017 IEEE 56th Annual Conference on Decision and Control (CDC), 2242--2253. IEEE

    work page 2017

  6. [6]

    Beckers, T., Colombo, L.J., and Hirche, S. (2022). Safe trajectory tracking for underactuated vehicles with partially unknown dynamics. AIMS Journal

    work page 2022

  7. [7]

    Chow, Y., Tamar, A., Mannor, S., and Pavone, M. (2015). Risk-sensitive and robust decision-making: a cvar optimization approach. Advances in neural information processing systems, 28

    work page 2015

  8. [8]

    Dixit, A., Ahmadi, M., and Burdick, J.W. (2023). Risk-averse receding horizon motion planning for obstacle avoidance using coherent risk measures. Artificial Intelligence, 325, 104018

    work page 2023

Show all 27 references
  1. [9]

    Hakobyan, A., Kim, G.C., and Yang, I. (2019). Risk-aware motion planning and control using cvar-constrained optimization. IEEE Robotics and Automation letters, 4(4), 3924--3931

    2019

  2. [10]

    and Chung, W.K

    Heo, Y.J. and Chung, W.K. (2013). RRT -based path planning with kinematic constraints of auv in underwater structured environment. In 2013 10th International Conference on Ubiquitous Robots and Ambient Intelligence (URAI), 523--525. IEEE

    2013

  3. [11]

    Hong, S.M., Ha, K.N., and Kim, J.Y. (2020). Dynamics modeling and motion simulation of usv/uuv with linked underwater cable. Journal of Marine Science and Engineering, 8(5), 318

    2020

  4. [12]

    Kuwata, Y., Schouwenaars, T., Richards, A., and How, J. (2005). Robust constrained receding horizon control for trajectory planning. In AIAA Guidance, Navigation, and Control Conference and Exhibit, 6079

    2005

  5. [13]

    Lew, T., Bonalli, R., and Pavone, M. (2023). Risk-averse trajectory optimization via sample average approximation. IEEE Robotics and Automation Letters

    2023

  6. [14]

    Lew, T., Bonalli, R., and Pavone, M. (2024). Sample average approximation for stochastic programming with equality constraints. SIAM Journal on Optimization, 34(4), 3506--3533

    2024

  7. [15]

    Mathai, V., Loeffen, L.A.W.M., Chan, T.T.K., and Wildeman, S. (2019). Dynamics of heavy and buoyant underwater pendulums. Journal of Fluid Mechanics, 862, 348–363. doi:10.1017/jfm.2018.867

    2019 doi

  8. [16]

    Mesbah, A. (2016). Stochastic model predictive control: An overview and perspectives for future research. IEEE Control Systems Magazine, 36(6), 30--44

    2016

  9. [17]

    and Yamamoto, I

    Morinaga, A. and Yamamoto, I. (2023). Trajectory planning strategies and simulation for autonomous-surface-vehicle–remotely-operated-vehicle (asv–rov) cooperative system. Sensors and Materials, 35(2), 411--422

    2023

  10. [18]

    Petres, C., Pailhas, Y., Patron, P., Evans, J., Petillot, Y., and Lane, D. (2009). Trajectory planning for autonomous underwater vehicles. In Underwater Vehicles, 399--416. IntechOpen

    2009

  11. [19]

    Sacchi, N., Simetti, E., Antonelli, G., Indiveri, G., Creuze, V., and Gouttefarde, M. (2022). Analysis of hybrid cable-thruster actuated rov in heavy lifting interventions. In 2022 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 8430--8435. doi:10.1...

    2022

  12. [20]

    SeaClear2.0 Project

    Seaclear Consortium (2023). SeaClear2.0 Project . Available at: https://www.seaclear2.eu/ (Accessed: 2025-03-15)

    2023

  13. [21]

    Siv c ev, S., Coleman, J., Omerdi \'c , E., Dooly, G., and Toal, D. (2018). Underwater manipulators: A review. Ocean engineering, 163, 431--450

    2018

  14. [22]

    Sopasakis, P., Herceg, D., Bemporad, A., and Patrinos, P. (2019). Risk-averse model predictive control. Automatica, 100, 281--288

    2019

  15. [23]

    Williams, G., Aldrich, A., and Theodorou, E.A. (2017). Model predictive path integral control: From theory to parallel computation. Journal of Guidance, Control, and Dynamics, 40(2), 344--357

    2017

  16. [24]

    Williams, G., Drews, P., Goldfain, B., Rehg, J.M., and Theodorou, E.A. (2018). Information-theoretic model predictive control: Theory and applications to autonomous driving. IEEE Transactions on Robotics, 34(6), 1603--1622

    2018

  17. [25]

    Zereik, E., Bibuli, M., Mi s kovi \'c , N., Ridao, P., and Pascoal, A. (2018). Challenges and future trends in marine robotics. Annual Reviews in Control, 46, 350--368

    2018

  18. [26]

    Zhao, C., Thies, P.R., and Johanning, L. (2021). Investigating the winch performance in an ASV/ROV autonomous inspection system. Applied Ocean Research, 115, 102827

    2021

  19. [27]

    Zhao, C., Thies, P.R., and Johanning, L. (2022). Offshore inspection mission modelling for an asv/rov system. Ocean Engineering, 259, 111899

    2022

Pith tools

Reviewed August 6, 2026 · model on record in the stance chip above.