Integral Resonant Control for vibration damping and precise tip-positioning of a single-link flexible manipulator

Peer reviewedPostprin

Applied Safety Critical Control

There is currently a clear gap between control-theoretical results and the reality of robotic implementation, in the sense that it is very difficult to transfer analytical guarantees to practical ones. This is especially problematic when trying to design safety-critical systems where failure is not an option. While there is a vast body of work on safety and reliability in control theory, very little of it is actually used in practice where safety margins are typically empiric and/or heuristic. Nevertheless, it is still widely accepted that a solution to these problems can only emerge from rigorous analysis, mathematics, and methods. In this work, we therefore seek to help bridge this gap by revisiting and expanding existing theoretical results in light of the complexity of hardware implementation. To that end, we begin by making a clear theoretical distinction between systems and models, and outline how the two need to be related for guarantees to transfer from the latter to the former. We then formalize various imperfections of reality that need to be accounted for at a model level to provide theoretical results with better applicability. We then discuss the reality of digital controller implementation and present the mathematical constraints that theoretical control laws must satisfy for them to be implementable on real hardware. In light of these discussions, we derive new realizable set-invariance conditions that, if properly enforced, can guarantee safety with an arbitrary high levels of confidence. We then discuss how these conditions can be rigorously enforced in a systematic and minimally invasive way through convex optimization-based Safety Filters. Multiple safety filter formulations are proposed with varying levels of complexity and applicability. To enable the use of these safety filters, a new algorithm is presented to compute appropriate control invariant sets and guarantee feasibility of the optimization problem defining these filters. The effectiveness of this approach is demonstrated in simulation on a nonlinear inverted pendulum and experimentally on a simple vehicle. The aptitude of the framework to handle a system's dynamics uncertainty is illustrated by varying the mass of the vehicle and showcasing when safety is conserved. Then, the aptitude of this approach to provide guarantees that account for controller implementation's constraints is illustrated by varying the frequency of the control loop and again showcasing when safety is conserved. In the second part of this work, we revisit the safety filtering approach in a way that addresses the scalability issues of the first part of this work. There are two main approaches to safety-critical control. The first one relies on computation of control invariant sets and was presented in the first part of this work. The second approach draws from the topic of optimal control and relies on the ability to realize Model-Predictive-Controllers online to guarantee the safety of a system. In that online approach, safety is ensured at a planning stage by solving the control problem subject for some explicitly defined constraints on the state and control input. Both approaches have distinct advantages but also major drawbacks that hinder their practical effectiveness, namely scalability for the first one and computational complexity for the second one. We therefore present an approach that draws from the advantages of both approaches to deliver efficient and scalable methods of ensuring safety for nonlinear dynamical systems. In particular, we show that identifying a backup control law that stabilizes the system is in fact sufficient to exploit some of the set-invariance conditions presented in the first part of this work. Indeed, one only needs to be able to numerically integrate the closed-loop dynamics of the system over a finite horizon under this backup law to compute all the information necessary for evaluating the regulation map and enforcing safety. The effect of relaxing the stabilization requirements of the backup law is also studied, and weaker but more practical safety guarantees are brought forward. We then explore the relationship between the optimality of the backup law and how conservative the resulting safety filter is. Finally, methods of selecting a safe input with varying levels of trade-off between conservativeness and computational complexity are proposed and illustrated on multiple robotic systems, namely: a two-wheeled inverted pendulum (Segway), an industrial manipulator, a quadrotor, and a lower body exoskeleton.</p

A passivity based control methodology for flexible joint robots with application to a simplified shuttle RMS arm

The main goal is to develop a general theory for the control of flexible robots, including flexible joint robots, flexible link robots, rigid bodies with flexible appendages, etc. As part of the validation, the theory is applied to the control law development for a test example which consists of a three-link arm modeled after the shoulder yaw joint of the space shuttle remote manipulator system (RMS). The performance of the closed loop control system is then compared with the performance of the existing RMS controller to demonstrate the effectiveness of the proposed approach. The theoretical foundation of this new approach to the control of flexible robots is presented and its efficacy is demonstrated through simulation results on the three-link test arm

Design of Adaptive Sliding Mode Fuzzy Control for Robot Manipulator Based on Extended Kalman Filter

In this work, a new adaptive motion control scheme for robust performance control of robot manipulators is presented. The proposed scheme is designed by combining the fuzzy logic control with the sliding mode control based on extended Kalman filter. Fuzzy logic controllers have been used successfully in many applications and were shown to be superior to the classical controllers for some nonlinear systems. Sliding mode control is a powerful approach for controlling nonlinear and uncertain systems. It is a robust control method and can be applied in the presence of model uncertainties and parameter disturbances, provided that the bounds of these uncertainties and disturbances are known. We have designed a new adaptive Sliding Mode Fuzzy Control (SMFC) method that requires only position measurements. These measurements and the input torques are used in an extended Kalman filter (EKF) to estimate the inertial parameters of the full nonlinear robot model as well as the joint positions and velocities. These estimates are used by the SMFC to generate the input torques. The combination of the EKF and the SMFC is shown to result in a stable adaptive control scheme called trajectory-tracking adaptive robot with extended Kalman (TAREK) method. The theory behind TAREK method provides clear guidelines on the selection of the design parameters for the controller. The proposed controller is applied to a two-link robot manipulator. Computer simulations show the robust performance of the proposed scheme

Task-space dynamic control of underwater robots

This thesis is concerned with the control aspects for underwater tasks performed by marine robots. The mathematical models of an underwater vehicle and an underwater vehicle with an onboard manipulator are discussed together with their associated properties. The task-space regulation problem for an underwater vehicle is addressed where the desired target is commonly specified as a point. A new control technique is proposed where the multiple targets are defined as sub-regions. A fuzzy technique is used to handle these multiple sub-region criteria effectively. Due to the unknown gravitational and buoyancy forces, an adaptive term is adopted in the proposed controller. An extension to a region boundary-based control law is then proposed for an underwater vehicle to illustrate the flexibility of the region reaching concept. In this novel controller, a desired target is defined as a boundary instead of a point or region. For a mapping of the uncertain restoring forces, a least-squares estimation algorithm and the inverse Jacobian matrix are utilised in the adaptive control law. To realise a new tracking control concept for a kinematically redundant robot, subregion tracking control schemes with a sub-tasks objective are developed for a UVMS. In this concept, the desired objective is specified as a moving sub-region instead of a trajectory. In addition, due to the system being kinematically redundant, the controller also enables the use of self-motion of the system to perform sub-tasks (drag minimisation, obstacle avoidance, manipulability and avoidance of mechanical joint limits)

A family of asymptotically stable control laws for flexible robots based on a passivity approach

A general family of asymptotically stabilizing control laws is introduced for a class of nonlinear Hamiltonian systems. The inherent passivity property of this class of systems and the Passivity Theorem are used to show the closed-loop input/output stability which is then related to the internal state space stability through the stabilizability and detectability condition. Applications of these results include fully actuated robots, flexible joint robots, and robots with link flexibility

Simultaneous Intrinsic and Extrinsic Parameter Identification of a Hand-Mounted Laser-Vision Sensor

In this paper, we propose a simultaneous intrinsic and extrinsic parameter identification of a hand-mounted laser-vision sensor (HMLVS). A laser-vision sensor (LVS), consisting of a camera and a laser stripe projector, is used as a sensor component of the robotic measurement system, and it measures the range data with respect to the robot base frame using the robot forward kinematics and the optical triangulation principle. For the optimal estimation of the model parameters, we applied two optimization techniques: a nonlinear least square optimizer and a particle swarm optimizer. Best-fit parameters, including both the intrinsic and extrinsic parameters of the HMLVS, are simultaneously obtained based on the least-squares criterion. From the simulation and experimental results, it is shown that the parameter identification problem considered was characterized by a highly multimodal landscape; thus, the global optimization technique such as a particle swarm optimization can be a promising tool to identify the model parameters for a HMLVS, while the nonlinear least square optimizer often failed to find an optimal solution even when the initial candidate solutions were selected close to the true optimum. The proposed optimization method does not require good initial guesses of the system parameters to converge at a very stable solution and it could be applied to a kinematically dissimilar robot system without loss of generality

Model-Based Robot Control and Multiprocessor Implementation

Model-based control of robot manipulators has been gaining momentum in recent years. Unfortunately there are very few experimental validations to accompany simulation results and as such majority of conclusions drawn lack the credibility associated with the real control implementation

Experiments in cooperative-arm object manipulation with a two-armed free-flying robot

Developing computed-torque controllers for complex manipulator systems using current techniques and tools is difficult because they address the issues pertinent to simulation, as opposed to control. A new formulation of computed-torque (CT) control that leads to an automated computer-torque robot controller program is presented. This automated tool is used for simulations and experimental demonstrations of endpoint and object control from a free-flying robot. A new computed-torque formulation states the multibody control problem in an elegant, homogeneous, and practical form. A recursive dynamics algorithm is presented that numerically evaluates kinematics and dynamics terms for multibody systems given a topological description. Manipulators may be free-flying, and may have closed-chain constraints. With the exception of object squeeze-force control, the algorithm does not deal with actuator redundancy. The algorithm is used to implement an automated 2D computed-torque dynamics and control package that allows joint, endpoint, orientation, momentum, and object squeeze-force control. This package obviates the need for hand-derivation of kinematics and dynamics, and is used for both simulation and experimental control. Endpoint control experiments are performed on a laboratory robot that has two arms to manipulate payloads, and uses an air bearing to achieve very-low drag characteristics. Simulations and experimental data for endpoint and object controllers are presented for the experimental robot - a complex dynamic system. There is a certain rather wide set of conditions under which CT endpoint controllers can neglect robot base accelerations (but not motions) and achieve comparable performance including base accelerations in the model. The regime over which this simplification holds is explored by simulation and experiment

Modelling and control of lightweight underwater vehicle-manipulator systems

This thesis studies the mathematical description and the low-level control structures for underwater robotic systems performing motion and interaction tasks. The main focus is on the study of lightweight underwater-vehicle manipulator systems. A description of the dynamic and hydrodynamic modelling of the underwater vehicle-manipulator system (UVMS) is presented and a study of the coupling effects between the vehicle and manipulator is given. Through simulation results it is shown that the vehicle’s capabilities are degraded by the motion of the manipulator, when it has a considerable mass with respect to the vehicle. Understanding the interaction effects between the two subsystems is beneficial in developing new control architectures that can improve the performance of the system. A control strategy is proposed for reducing the coupling effects between the two subsystems when motion tasks are required. The method is developed based on the mathematical model of the UVMS and the estimated interaction effects. Simulation results show the validity of the proposed control structure even in the presence of uncertainties in the dynamic model. The problem of autonomous interaction with the underwater environment is further addressed. The thesis proposes a parallel position/force control structure for lightweight underwater vehicle-manipulator systems. Two different strategies for integrating this control law on the vehicle-manipulator structure are proposed. The first strategy uses the parallel control law for the manipulator while a different control law, the Proportional Integral Limited control structure, is used for the vehicle. The second strategy treats the underwater vehicle-manipulator system as a single system and the parallel position/force law is used for the overall system. The low level parallel position/force control law is validated through practical experiments using the HDT-MK3-M electric manipulator. The Proportional Integral Limited control structure is tested using a 5 degrees-of-freedom underwater vehicle in a wave-tank facility. Furthermore, an adaptive tuning method based on interaction theory is proposed for adjusting the gains of the controller. The experimental results show that the method is advantageous as it decreases the complexity of the manual tuning otherwise required and reduces the energy consumption. The main objectives of this thesis are to understand and accurately represent the behaviour of an underwater vehiclemanipulator system, to evaluate this system when in contact with the environment and to design informed low-level control structures based on the observations made through the mathematical study of the system. The concepts presented in this thesis are not restricted to only vehicle-manipulator systems but can be applied to different other multibody robotic systems