This paper addresses the sensitivity analysis for hybrid systems with discontinuous (jumping) state trajectories. We consider state-triggered jumps in the state evolution, potentially accompanied by mode switching in the control vector field as well. For a given trajectory with state jumps, we show how to construct an approximation of a nearby perturbed trajectory corresponding to a small variation of the initial condition and input. A major complication in the construction of such an approximation is that, in general, the jump times corresponding to a nearby perturbed trajectory are not equal to those of the nominal one. The main contribution of this work is the development of a notion of error to clarify in which sense the approximate trajectory is, at each instant of time, a firstorder approximation of the perturbed trajectory. This notion of error naturally finds application in the (local) tracking problem of a time-varying reference trajectory of a hybrid system. To illustrate the possible use of this new error definition in the context of trajectory tracking, we outline how the standard linear trajectory tracking control for nonlinear systems -based on linear quadratic regulator (LQR) theory to compute the optimal feedback gain- could be generalized for hybrid systems.
In this work, we investigate the state stabilization and trajectory tracking problems of underactuated surface ships with full state model of having non-diagonal inertia and damping matrices. By combining the novel state transformations, the direct Lyapunov approach, and the nonlinear time-varying tools, the stabilization and the trajectory tracking controllers are developed respectively guaranteeing global uniform asymptotic convergence of the state to the desired set point and global exponential convergence to the desired reference trajectory via mild persistent exciting conditions. Simulati…
In this paper we consider the problem of stabilization and tracking of desired state trajectory for a wide range of nonlinear control problems with disturbances. We present the sufficient conditions for the existence of $C^k$ state feedback controllers and the process of their mathematical designing is described.
A novel dynamic model-based trajectory tracking control law is proposed for a four-wheel differentially driven mobile robot using a backstepping technique that guarantees the Lyapunov stability. The present work improves the work of Caracciolo et al. (ICRA 1999), a dynamic feedback linearization approach, by reducing the number of required assumptions and the number of state terms. We also thoroughly investigate on a gain tuning procedure which is often overlooked for nonlinear controllers. Finally, the performance of the proposed controller is compared with the dynamic feedback linearization …
This paper addresses the problem of designing a trajectory tracking control law for a quadrotor UAV, subsequent to complete failure of a single rotor. The control design problem considers the reduced state space which excludes the angular velocity and orientation about the vertical body axis. The proposed controller enables the quadrotor to track the orientation of this axis, and consequently any prescribed position trajectory using only three rotors. The control design is carried out in two stages. First, in order to track the reduced attitude dynamics, a geometric controller with two input t…
We study the tracking of a trajectory for a nonholonomic system by recasting the problem as a constrained optimal control problem. The cost function is chosen to minimize the error in positions and velocities between the trajectory of a nonholonomic system and the desired reference trajectory, both evolving on the distribution which defines the nonholonomic constraints. The problem is studied from a geometric framework. Optimality conditions are determined by the Pontryagin Maximum Principle and also from a variational point of view, which allows the construction of geometric integrators. Exam…
We treat the periodic trajectory tracking problem: given a periodic trajectory of a control-affine, left-invariant driftless system in a compact and connected Lie group $G$ and an initial condition in $G$, find another trajectory of the system satisfying the initial condition given and that asymptotically tracks the periodic trajectory. We solve this problem locally (for initial conditions in a neighborhood of some point of the periodic trajectory) when $G$ is semisimple and the system is Lie-determined (i.e. controllable), and only for a class of periodic trajectories (which we call regular).…
This work presents new methods and algorithms for tracking the shape and trajectory of moving reflecting obstacles with broken rays, or rays reflecting at an obstacle. While in tomography the focus of the reconstruction method is to recover the velocity structure of the domain, the shape and trajectory reconstruction procedure directly finds the shape and trajectory of the obstacle. The physical signal carrier for this innovative method are ultrasonic beams. When the speed of sound is constant, the rays are straight line segments and the shape and trajectory of moving objects will be reconstru…
Motion planning for autonomous vehicles requires spatio-temporal motion plans (i.e. state trajectories) to account for dynamic obstacles. This requires a trajectory tracking control process which faithfully tracks planned trajectories. In this paper, a control scheme is presented which first optimizes a planned trajectory and then tracks the optimized trajectory using a feedback-feedforward controller. The feedforward element is calculated in a model predictive manner with a cost function focusing on driving performance. Stability of the error dynamic is then guaranteed by the design of the fe…
We present a novel reformulation of nonsmooth differential equations with state jumps which enables their easier simulation and use in optimal control problems without the need of using integer variables. The main idea is to introduce an auxiliary differential equation to mimic the state jump map. Thereby, also a clock state is introduced which does not evolve during the runtime of the auxiliary system. The pieces of the trajectory that correspond to the parts when the clock state was evolving recover the solution of the original system with jumps. Our reformulation results in nonsmooth ordina…
