-
Robust Stochastic Shortest-Path Planning via Risk-Sensitive Incremental Sampling
Authors:
Clinton Enwerem,
Erfaun Noorani,
John S. Baras,
Brian M. Sadler
Abstract:
With the pervasiveness of Stochastic Shortest-Path (SSP) problems in high-risk industries, such as last-mile autonomous delivery and supply chain management, robust planning algorithms are crucial for ensuring successful task completion while mitigating hazardous outcomes. Mainstream chance-constrained incremental sampling techniques for solving SSP problems tend to be overly conservative and typi…
▽ More
With the pervasiveness of Stochastic Shortest-Path (SSP) problems in high-risk industries, such as last-mile autonomous delivery and supply chain management, robust planning algorithms are crucial for ensuring successful task completion while mitigating hazardous outcomes. Mainstream chance-constrained incremental sampling techniques for solving SSP problems tend to be overly conservative and typically do not consider the likelihood of undesirable tail events. We propose an alternative risk-aware approach inspired by the asymptotically-optimal Rapidly-Exploring Random Trees (RRT*) planning algorithm, which selects nodes along path segments with minimal Conditional Value-at-Risk (CVaR). Our motivation rests on the step-wise coherence of the CVaR risk measure and the optimal substructure of the SSP problem. Thus, optimizing with respect to the CVaR at each sampling iteration necessarily leads to an optimal path in the limit of the sample size. We validate our approach via numerical path planning experiments in a two-dimensional grid world with obstacles and stochastic path-segment lengths. Our simulation results show that incorporating risk into the tree growth process yields paths with lengths that are significantly less sensitive to variations in the noise parameter, or equivalently, paths that are more robust to environmental uncertainty. Algorithmic analyses reveal similar query time and memory space complexity to the baseline RRT* procedure, with only a marginal increase in processing time. This increase is offset by significantly lower noise sensitivity and reduced planner failure rates.
△ Less
Submitted 16 August, 2024;
originally announced August 2024.
-
Safe Collective Control under Noisy Inputs and Competing Constraints via Non-Smooth Barrier Functions
Authors:
Clinton Enwerem,
John S. Baras
Abstract:
We consider the problem of safely coordinating ensembles of identical autonomous agents to conduct complex missions with conflicting safety requirements and under noisy control inputs. Using non-smooth control barrier functions (CBFs) and stochastic model-predictive control as springboards, and by adopting an extrinsic approach where the ensemble is treated as a unified dynamic entity, we devise a…
▽ More
We consider the problem of safely coordinating ensembles of identical autonomous agents to conduct complex missions with conflicting safety requirements and under noisy control inputs. Using non-smooth control barrier functions (CBFs) and stochastic model-predictive control as springboards, and by adopting an extrinsic approach where the ensemble is treated as a unified dynamic entity, we devise a method to synthesize safety-aware control inputs for uncertain collectives. Drawing upon stochastic CBF theory and recent developments in Boolean CBF composition, our method proceeds by smoothing a Boolean-composed CBF and solving a stochastic optimization problem where each agent's forcing term is restricted to the affine subspace of control inputs certified by the combined CBF. For the smoothing step, we employ a polynomial approximation scheme, providing evidence for its advantage in generating more conservative yet sufficiently-filtered control inputs than the smoother but more aggressive equivalents produced from an approximation technique based on the log-sum-exp function. To further demonstrate the utility of the proposed method, we present an upper bound for the expected CBF approximation error, along with results from simulations of a single-integrator collective under velocity perturbations. Lastly, we compare these results with those obtained using a naive state-feedback controller lacking safety filters.
△ Less
Submitted 28 March, 2024; v1 submitted 6 November, 2023;
originally announced November 2023.
-
Consensus-Based Leader-Follower Formation Tracking for Control-Affine Nonlinear Multiagent Systems
Authors:
Clinton Enwerem,
John S. Baras
Abstract:
In the typical multiagent formation tracking problem centered on consensus, the prevailing assumption in the literature is that the agents' nonlinear models can be approximated by integrator systems, by their feedback-linearized equivalents, or by dynamics composed of deterministic linear and nonlinear terms. The resulting approaches associated with such assumptions, however, are hardly applicable…
▽ More
In the typical multiagent formation tracking problem centered on consensus, the prevailing assumption in the literature is that the agents' nonlinear models can be approximated by integrator systems, by their feedback-linearized equivalents, or by dynamics composed of deterministic linear and nonlinear terms. The resulting approaches associated with such assumptions, however, are hardly applicable to general nonlinear systems. To this end, we present consensus-based control laws for multiagent formation tracking in finite-dimensional state space, with the agents represented by a more general class of dynamics: control-affine nonlinear systems. The agents also exchange information via a leader-follower communication topology modeled as an undirected and connected graph with a single leader node. By leveraging standard tools from algebraic graph theory and Lyapunov analysis, we first derive a locally asymptotically stabilizing formation tracking law. Next, to demonstrate the effectiveness of our approach, we present results from numerical simulations of an example in robotics. These results -- together with a comparison of the formation errors obtained with our approach and those realized via an optimization-based method -- further validate our theoretical propositions.
△ Less
Submitted 17 September, 2023;
originally announced September 2023.
-
Distributed Optimal Formation Control for an Uncertain Multiagent System in the Plane
Authors:
Clinton Enwerem,
John Baras,
Danilo Romero
Abstract:
In this paper, we present a distributed optimal multiagent control scheme for quadrotor formation tracking under localization errors. Our control architecture is based on a leader-follower approach, where a single leader quadrotor tracks a desired trajectory while the followers maintain their relative positions in a triangular formation. We begin by modeling the quadrotors as particles in the YZ-p…
▽ More
In this paper, we present a distributed optimal multiagent control scheme for quadrotor formation tracking under localization errors. Our control architecture is based on a leader-follower approach, where a single leader quadrotor tracks a desired trajectory while the followers maintain their relative positions in a triangular formation. We begin by modeling the quadrotors as particles in the YZ-plane evolving under dynamics with uncertain state information. Next, by formulating the formation tracking task as an optimization problem -- with a constraint-augmented Lagrangian subject to dynamic constraints -- we solve for the control law that leads to an optimal solution in the control and trajectory error cost-minimizing sense. Results from numerical simulations show that for the planar quadrotor model considered -- with uncertainty in sensor measurements modeled as Gaussian noise -- the resulting optimal control is able to drive each agent to achieve the desired global objective: leader trajectory tracking with formation maintenance. Finally, we evaluate the performance of the control law using the tracking and formation errors of the multiagent system.
△ Less
Submitted 28 January, 2023; v1 submitted 14 January, 2023;
originally announced January 2023.
-
Optimal Controller Tuning Technique for a First-Order Process with Time Delay
Authors:
Clinton Enwerem,
Ihechiluru Okoro
Abstract:
We present a controller tuning strategy for first-order plus time delay (FOPTD) processes, where the time delay in the model is approximated using the Padé function. Using Routh-Hurwitz stability analysis, we derive the gain that gives rise to desirable PID controller settings. The resulting PID controller, now correctly tuned, produces satisfactory closed-loop behavior and stabilizes the first-or…
▽ More
We present a controller tuning strategy for first-order plus time delay (FOPTD) processes, where the time delay in the model is approximated using the Padé function. Using Routh-Hurwitz stability analysis, we derive the gain that gives rise to desirable PID controller settings. The resulting PID controller, now correctly tuned, produces satisfactory closed-loop behavior and stabilizes the first-order plant. Our proposed technique eliminates the dead-time component in the model and results in a minimum-phase system with all of its poles and zeros in the left-half $s$-plane. To demonstrate the effectiveness of our approach, we present control simulation results from an in-depth performance comparison between our technique and other established model-based strategies used for the control of time-delayed systems. These results prove that, for the FOPTD model, Padé approximation eliminates the undesirable effects of the time delay and promises a faster tracking performance superior to conventional model-based controllers.
△ Less
Submitted 8 April, 2023; v1 submitted 15 October, 2022;
originally announced October 2022.
