Mobile Formation Coordination and Tracking Control for Multiple Non-holonomic Vehicles

This paper addresses forward motion control for trajectory tracking and mobile formation coordination for a group of non-holonomic vehicles on SE(2). Firstly, by constructing an intermediate attitude variable which involves vehicles' position information and desired attitude, the translational and rotational control inputs are designed in two stages to solve the trajectory tracking problem. Secondly, the coordination relationships of relative positions and headings are explored thoroughly for a group of non-holonomic vehicles to maintain a mobile formation with rigid body motion constraints. We prove that, except for the cases of parallel formation and translational straight line formation, a mobile formation with strict rigid-body motion can be achieved if and only if the ratios of linear speed to angular speed for each individual vehicle are constants. Motion properties for mobile formation with weak rigid-body motion are also demonstrated. Thereafter, based on the proposed trajectory tracking approach, a distributed mobile formation control law is designed under a directed tree graph. The performance of the proposed controllers is validated by both numerical simulations and experiments

Optimized state feedback regulation of 3DOF helicopter system via extremum seeking

In this paper, an optimized state feedback regulation of a 3 degree of freedom (DOF) helicopter is designed via extremum seeking (ES) technique. Multi-parameter ES is applied to optimize the tracking performance via tuning State Vector Feedback with Integration of the Control Error (SVFBICE). Discrete multivariable version of ES is developed to minimize a cost function that measures the performance of the controller. The cost function is a function of the error between the actual and desired axis positions. The controller parameters are updated online as the optimization takes place. This method significantly decreases the time in obtaining optimal controller parameters. Simulations were conducted for the online optimization under both fixed and varying operating conditions. The results demonstrate the usefulness of using ES for preserving the maximum attainable performance

Virtual Structure Based Formation Tracking of Multiple Wheeled Mobile Robots: An Optimization Perspective

Today, with the increasing development of science and technology, many systems need to be optimized to find the optimal solution of the system. this kind of problem is also called optimization problem. Especially in the formation problem of multi-wheeled mobile robots, the optimization algorithm can help us to find the optimal solution of the formation problem. In this paper, the formation problem of multi-wheeled mobile robots is studied from the point of view of optimization. In order to reduce the complexity of the formation problem, we first put the robots with the same requirements into a group. Then, by using the virtual structure method, the formation problem is reduced to a virtual WMR trajectory tracking problem with placeholders, which describes the expected position of each WMR formation. By using placeholders, you can get the desired track for each WMR. In addition, in order to avoid the collision between multiple WMR in the group, we add an attraction to the trajectory tracking method. Because MWMR in the same team have different attractions, collisions can be easily avoided. Through simulation analysis, it is proved that the optimization model is reasonable and correct. In the last part, the limitations of this model and corresponding suggestions are given

Cooperative Control of Multiple Wheeled Mobile Robots: Normal and Faulty Situations

Recently, cooperative control of multiple unmanned vehicles has attracted a great deal of attention from scientific, industrial, and military aspects. Groups of unmanned ground, aerial, or marine vehicles working cooperatively lead to many advantages in a variety of applications such as: surveillance, search and exploration, cooperative reconnaissance, environmental monitoring, and cooperative manipulation, respectively. During mission execution, unmanned systems should travel autonomously between different locations, maintain a pre-defined formation shape, avoid collisions of obstacles and also other team members, and accommodate occurred faults and mitigate their negative effect on mission execution. The main objectives of this dissertation are to design novel algorithms for single wheeled mobile robots (WMRs) trajectory tracking, cooperative control and obstacle avoidance of WMRs in fault-free situations. In addition, novel algorithms are developed for fault-tolerant cooperative control (FTCC) with integration of fault detection and diagnosis (FDD) scheme. In normal/fault-free cases, an integrated approach combining input-output feedback linearization and distributed model predictive control (MPC) techniques is designed and implemented on a team of WMRs to accomplish the trajectory tracking as well as the cooperative task. An obstacle avoidance algorithm based on mechanical impedance principle is proposed to avoid potential collisions of surrounding obstacles. Moreover, the proposed control algorithm is implemented to a team of WMRs for pairing with a team of unmanned aerial vehicles (UAVs) for forest monitoring and fire detection applications. When actuator faults occur in one of the robots, two cases are explicitly considered: i) if the faulty robot cannot complete its assigned task due to a severe fault, then the faulty robot has to get out from the formation mission, and an FTCC strategy is designed such that the tasks of the WMRs team are re-assigned to the remaining healthy robots to complete the mission with graceful performance degradation. Two methods are used to investigate this case: the Graph Theory, and formulating the FTCC problem as an optimal assignment problem; and ii) if the faulty robot can continue the mission with degraded performance, then the other team members reconfigure the controllers considering the capability of the faulty robot. Thus, the FTCC strategy is designed to re-coordinate the motion of each robot in the team. Within the proposed scheme, an FDD unit using a two-stage Kalman filter (TSKF) to detect and diagnose actuator faults is presented. In case of using any other nonlinear controller in fault-free case rather than MPC, and in case of severe fault occurrence, another FTCC strategy is presented. First, the new reconfiguration is formulated by an optimal assignment problem where each healthy WMR is assigned to a unique place. Second, the new formation can be reconfigured, while the objective is to minimize the time to achieve the new formation within the constraints of the WMRs' dynamics and collision avoidance. A hybrid approach of control parametrization and time discretization (CPTD) and particle swarm optimization (PSO) is proposed to address this problem. Since PSO cannot solve the continuous control inputs, CPTD is adopted to provide an approximate piecewise linearization of the control inputs. Therefore, PSO can be adopted to find the global optimum solution. In all cases, formation operation of the robot team is based on a leader-follower approach, whilst the control algorithm is implemented in a distributed manner. The results of the numerical simulations and real experiments demonstrate the effectiveness of the proposed algorithms in various scenarios

Cooperative Control of Multiple Wheeled Mobile Robots: Normal and Faulty Situations

Recently, cooperative control of multiple unmanned vehicles has attracted a great deal of attention from scientific, industrial, and military aspects. Groups of unmanned ground, aerial, or marine vehicles working cooperatively lead to many advantages in a variety of applications such as: surveillance, search and exploration, cooperative reconnaissance, environmental monitoring, and cooperative manipulation, respectively. During mission execution, unmanned systems should travel autonomously between different locations, maintain a pre-defined formation shape, avoid collisions of obstacles and also other team members, and accommodate occurred faults and mitigate their negative effect on mission execution. The main objectives of this dissertation are to design novel algorithms for single wheeled mobile robots (WMRs) trajectory tracking, cooperative control and obstacle avoidance of WMRs in fault-free situations. In addition, novel algorithms are developed for fault-tolerant cooperative control (FTCC) with integration of fault detection and diagnosis (FDD) scheme. In normal/fault-free cases, an integrated approach combining input-output feedback linearization and distributed model predictive control (MPC) techniques is designed and implemented on a team of WMRs to accomplish the trajectory tracking as well as the cooperative task. An obstacle avoidance algorithm based on mechanical impedance principle is proposed to avoid potential collisions of surrounding obstacles. Moreover, the proposed control algorithm is implemented to a team of WMRs for pairing with a team of unmanned aerial vehicles (UAVs) for forest monitoring and fire detection applications. When actuator faults occur in one of the robots, two cases are explicitly considered: i) if the faulty robot cannot complete its assigned task due to a severe fault, then the faulty robot has to get out from the formation mission, and an FTCC strategy is designed such that the tasks of the WMRs team are re-assigned to the remaining healthy robots to complete the mission with graceful performance degradation. Two methods are used to investigate this case: the Graph Theory, and formulating the FTCC problem as an optimal assignment problem; and ii) if the faulty robot can continue the mission with degraded performance, then the other team members reconfigure the controllers considering the capability of the faulty robot. Thus, the FTCC strategy is designed to re-coordinate the motion of each robot in the team. Within the proposed scheme, an FDD unit using a two-stage Kalman filter (TSKF) to detect and diagnose actuator faults is presented. In case of using any other nonlinear controller in fault-free case rather than MPC, and in case of severe fault occurrence, another FTCC strategy is presented. First, the new reconfiguration is formulated by an optimal assignment problem where each healthy WMR is assigned to a unique place. Second, the new formation can be reconfigured, while the objective is to minimize the time to achieve the new formation within the constraints of the WMRs' dynamics and collision avoidance. A hybrid approach of control parametrization and time discretization (CPTD) and particle swarm optimization (PSO) is proposed to address this problem. Since PSO cannot solve the continuous control inputs, CPTD is adopted to provide an approximate piecewise linearization of the control inputs. Therefore, PSO can be adopted to find the global optimum solution. In all cases, formation operation of the robot team is based on a leader-follower approach, whilst the control algorithm is implemented in a distributed manner. The results of the numerical simulations and real experiments demonstrate the effectiveness of the proposed algorithms in various scenarios

Robust neurooptimal control for a robot via adaptive dynamic programming

We aim at the optimization of the tracking control of a robot to improve the robustness, under the effect of unknown nonlinear perturbations. First, an auxiliary system is introduced, and optimal control of the auxiliary system can be seen as an approximate optimal control of the robot. Then, neural networks (NNs) are employed to approximate the solution of the Hamilton-Jacobi-Isaacs equation under the frame of adaptive dynamic programming. Next, based on the standard gradient attenuation algorithm and adaptive critic design, NNs are trained depending on the designed updating law with relaxing the requirement of initial stabilizing control. In light of the Lyapunov stability theory, all the error signals can be proved to be uniformly ultimately bounded. A series of simulation studies are carried out to show the effectiveness of the proposed control

Bio-inspired robotic control in underactuation: principles for energy efficacy, dynamic compliance interactions and adaptability.

Biological systems achieve energy efficient and adaptive behaviours through extensive autologous and exogenous compliant interactions. Active dynamic compliances are created and enhanced from musculoskeletal system (joint-space) to external environment (task-space) amongst the underactuated motions. Underactuated systems with viscoelastic property are similar to these biological systems, in that their self-organisation and overall tasks must be achieved by coordinating the subsystems and dynamically interacting with the environment. One important question to raise is: How can we design control systems to achieve efficient locomotion, while adapt to dynamic conditions as the living systems do? In this thesis, a trajectory planning algorithm is developed for underactuated microrobotic systems with bio-inspired self-propulsion and viscoelastic property to achieve synchronized motion in an energy efficient, adaptive and analysable manner. The geometry of the state space of the systems is explicitly utilized, such that a synchronization of the generalized coordinates is achieved in terms of geometric relations along the desired motion trajectory. As a result, the internal dynamics complexity is sufficiently reduced, the dynamic couplings are explicitly characterised, and then the underactuated dynamics are projected onto a hyper-manifold. Following such a reduction and characterization, we arrive at mappings of system compliance and integrable second-order dynamics with the passive degrees of freedom. As such, the issue of trajectory planning is converted into convenient nonlinear geometric analysis and optimal trajectory parameterization. Solutions of the reduced dynamics and the geometric relations can be obtained through an optimal motion trajectory generator. Theoretical background of the proposed approach is presented with rigorous analysis and developed in detail for a particular example. Experimental studies are conducted to verify the effectiveness of the proposed method. Towards compliance interactions with the environment, accurate modelling or prediction of nonlinear friction forces is a nontrivial whilst challenging task. Frictional instabilities are typically required to be eliminated or compensated through efficiently designed controllers. In this work, a prediction and analysis framework is designed for the self-propelled vibro-driven system, whose locomotion greatly relies on the dynamic interactions with the nonlinear frictions. This thesis proposes a combined physics-based and analytical-based approach, in a manner that non-reversible characteristic for static friction, presliding as well as pure sliding regimes are revealed, and the frictional limit boundaries are identified. Nonlinear dynamic analysis and simulation results demonstrate good captions of experimentally observed frictional characteristics, quenching of friction-induced vibrations and satisfaction of energy requirements. The thesis also performs elaborative studies on trajectory tracking. Control schemes are designed and extended for a class of underactuated systems with concrete considerations on uncertainties and disturbances. They include a collocated partial feedback control scheme, and an adaptive variable structure control scheme with an elaborately designed auxiliary control variable. Generically, adaptive control schemes using neural networks are designed to ensure trajectory tracking. Theoretical background of these methods is presented with rigorous analysis and developed in detail for particular examples. The schemes promote the utilization of linear filters in the control input to improve the system robustness. Asymptotic stability and convergence of time-varying reference trajectories for the system dynamics are shown by means of Lyapunov synthesis

Rolling Isolation Systems: Modeling, Analysis, and Assessment

<p>The rolling isolation system (RIS) studied in this dissertation functions on the principle of a rolling pendulum; an isolated object rests on a steel frame that is supported at its corners by ball-bearings that roll between shallow steel bowls, dynamically decoupling the floor motion from the response of the object. The primary focus of this dissertation is to develop predictive models that can capture experimentally-observed phenomena and to advance the state-of-the-art by proposing new isolation technologies to surmount current performance limitations. To wit, a double RIS increases the system's displacement capacity, and semi-active and passive damped RISs suppress the system's displacement response.</p><p>This dissertation illustrates the performance of various high-performance isolation strategies using experimentally-validated predictive models. Effective modeling of RISs is complicated by the nonholonomic and chaotic nature of these systems which to date has not received much attention. Motivated by this observation, the first part of this dissertation addresses the high-fidelity modeling of a single, undamped RIS, and later this theory is augmented to account for the double (or stacked) configuration and the supplemental damping via rubber-coated bowl surfaces. The system's potential energy function (i.e. conical bowl shape) and energy dissipation model are calibrated to free-response experiments. Forced-response experiments successfully validate the models by comparing measured and predicted peak displacement and acceleration responses over a range of operating conditions.</p><p>Following the experimental analyses, numerical simulations demonstrate the potential benefits of the proposed technologies. This dissertation presents a method to optimize damping force trajectories subject to constraints imposed by the physical implementation of a particular controllable damper. Potential improvements in terms of acceleration response are shown to be achievable with the semi-active RIS. Finally, extensive time-history analyses establish how the undamped and damped RISs perform when located inside biaxial, hysteretic, multi-story structures under recorded earthquake ground motions. General design recommendations, supported by critical-disturbance spectra and peak-response distributions, are prescribed so as to ensure the uninterrupted operation of vital equipment.</p>Dissertatio