Model predictive control and trajectory optimization of large vehicle-manipulators

In this paper, a model predictive control (MPC) is developed for on- and off-road mid-sized heavy duty vehicle-manipulator systems with a hydraulic working arm. The proposed concept for the control model is also new in the sense of working only within a local reference coordinate-system relative to the reference trajectory (so-called Fren´et-System). The control model only needs the errors to the reference trajectory. In contrast to other state-of-the-art approaches, there is no global localization method necessary. The control model is kept as simple as possible, to allow real-time motion prediction of the real system. For this reason, a kinematic model is used in the MPC which consists of a bicycle model and a planar robotic arm with two control variables. The dynamics of the overall system are considered as optimization constraints, assuming that the optimized system inputs and states are kinetically and dynamically feasible. Through this control method, the dual-trajectories are also optimized and they provide smooth motions for the overall system. The underlying control of the robotic arm is realized with a proportional–integral–derivative (PID) controller with feedback linearization and gravity compensation. The control algorithm is tested and validated in a MATLAB/Simulink simulation environment

An Explicit Formulation of Singularity-Free Dynamic Equations of Mechanical Systems in Lagrangian Form---Part Two: Multibody Systems

This paper presents the explicit dynamic equations of multibody mechanical systems. This is the second paper on this topic. In the first paper the dynamics of a single rigid body from the Boltzmann--Hamel equations were derived. In this paper these results are extended to also include multibody systems. We show that when quasi-velocities are used, the part of the dynamic equations that appear from the partial derivatives of the system kinematics are identical to the single rigid body case, but in addition we get terms that come from the partial derivatives of the inertia matrix, which are not present in the single rigid body case. We present for the first time the complete and correct derivation of multibody systems based on the Boltzmann--Hamel formulation of the dynamics in Lagrangian form where local position and velocity variables are used in the derivation to obtain the singularity-free dynamic equations. The final equations are written in global variables for both position and velocity. The main motivation of these papers is to allow practitioners not familiar with differential geometry to implement the dynamic equations of rigid bodies without the presence of singularities. Presenting the explicit dynamic equations also allows for more insight into the dynamic structure of the system. Another motivation is to correct some errors commonly found in the literature. Unfortunately, the formulation of the Boltzmann-Hamel equations used here are presented incorrectly. This has been corrected by the authors, but we present here, for the first time, the detailed mathematical details on how to arrive at the correct equations. We also show through examples that using the equations presented here, the dynamics of a single rigid body is reduced to the standard equations on a Lagrangian form, for example Euler's equations for rotational motion and Euler--Lagrange equations for free motion

MUSME 2011 4 th International Symposium on Multibody Systems and Mechatronics

El libro de actas recoge las aportaciones de los autores a través de los correspondientes artículos a la Dinámica de Sistemas Multicuerpo y la Mecatrónica (Musme). Estas disciplinas se han convertido en una importante herramienta para diseñar máquinas, analizar prototipos virtuales y realizar análisis CAD sobre complejos sistemas mecánicos articulados multicuerpo. La dinámica de sistemas multicuerpo comprende un gran número de aspectos que incluyen la mecánica, dinámica estructural, matemáticas aplicadas, métodos de control, ciencia de los ordenadores y mecatrónica. Los artículos recogidos en el libro de actas están relacionados con alguno de los siguientes tópicos del congreso: Análisis y síntesis de mecanismos ; Diseño de algoritmos para sistemas mecatrónicos ; Procedimientos de simulación y resultados ; Prototipos y rendimiento ; Robots y micromáquinas ; Validaciones experimentales ; Teoría de simulación mecatrónica ; Sistemas mecatrónicos ; Control de sistemas mecatrónicosUniversitat Politècnica de València (2011). MUSME 2011 4 th International Symposium on Multibody Systems and Mechatronics. Editorial Universitat Politècnica de València. http://hdl.handle.net/10251/13224Archivo delegad

A Contribution to the Design of Highly Redundant Compliant Aerial Manipulation Systems

Es ist vorhersehbar, dass die Luftmanipulatoren in den nächsten Jahrzehnten für viele Aufgaben eingesetzt werden, die entweder zu gefährlich oder zu teuer sind, um sie mit herkömmlichen Methoden zu bewältigen. In dieser Arbeit wird eine neuartige Lösung für die Gesamtsteuerung von hochredundanten Luftmanipulationssystemen vorgestellt. Die Ergebnisse werden auf eine Referenzkonfiguration angewendet, die als universelle Plattform für die Durchführung verschiedener Luftmanipulationsaufgaben etabliert wird. Diese Plattform besteht aus einer omnidirektionalen Drohne und einem seriellen Manipulator. Um den modularen Regelungsentwurf zu gewährleisten, werden zwei rechnerisch effiziente Algorithmen untersucht, um den virtuellen Eingang den Aktuatorbefehlen zuzuordnen. Durch die Integration eines auf einem künstlichen neuronalen Netz basierenden Diagnosemoduls und der rekonfigurierbaren Steuerungszuordnung in den Regelkreis, wird die Fehlertoleranz für die Drohne erzielt. Außerdem wird die Motorsättigung durch Rekonfiguration der Geschwindigkeits- und Beschleunigungsprofile behandelt. Für die Beobachtung der externen Kräfte und Drehmomente werden zwei Filter vorgestellt. Dies ist notwendig, um ein nachgiebiges Verhalten des Endeffektors durch die achsenselektive Impedanzregelung zu erreichen. Unter Ausnutzung der Redundanz des vorgestellten Luftmanipulators wird ein Regler entworfen, der nicht nur die Referenz der Endeffektor-Bewegung verfolgt, sondern auch priorisierte sekundäre Aufgaben ausführt. Die Wirksamkeit der vorgestellten Lösungen wird durch umfangreiche Tests überprüft, und das vorgestellte Steuerungssystem wird als sehr vielseitig und effektiv bewertet.:1 Introduction 2 Fundamentals 3 System Design and Modeling 4 Reconfigurable Control Allocation 5 Fault Diagnostics For Free Flight 6 Force and Torque Observer 7 Trajectory Generation 8 Hybrid Task Priority Control 9 System Integration and Performance Evaluation 10 ConclusionIn the following decades, aerial manipulators are expected to be deployed in scenarios that are either too dangerous for human beings or too expensive to be accomplished by traditional methods. This thesis presents a novel solution for the overall control of highly redundant aerial manipulation systems. The results are applied to a reference configuration established as a universal platform for performing various aerial manipulation tasks. The platform consists of an omnidirectional multirotor UAV and a serial manipulator. To ensure modular control design, two computationally efficient algorithms are studied to allocate the virtual input to actuator commands. Fault tolerance of the aerial vehicle is achieved by integrating a diagnostic module based on an artificial neural network and the reconfigurable control allocation into the control loop. Besides, the risk of input saturation of individual rotors is minimized by predicting and reconfiguring the speed and acceleration responses. Two filter-based observers are presented to provide the knowledge of external forces and torques, which is necessary to achieve compliant behavior of the end-effector through an axis-selective impedance control in the outer loop. Exploiting the redundancy of the proposed aerial manipulator, the author has designed a control law to achieve the desired end-effector motion and execute secondary tasks in order of priority. The effectiveness of the proposed designs is verified with extensive tests generated by following Monte Carlo method, and the presented control scheme is proved to be versatile and effective.:1 Introduction 2 Fundamentals 3 System Design and Modeling 4 Reconfigurable Control Allocation 5 Fault Diagnostics For Free Flight 6 Force and Torque Observer 7 Trajectory Generation 8 Hybrid Task Priority Control 9 System Integration and Performance Evaluation 10 Conclusio

Advanced Strategies for Robot Manipulators

Amongst the robotic systems, robot manipulators have proven themselves to be of increasing importance and are widely adopted to substitute for human in repetitive and/or hazardous tasks. Modern manipulators are designed complicatedly and need to do more precise, crucial and critical tasks. So, the simple traditional control methods cannot be efficient, and advanced control strategies with considering special constraints are needed to establish. In spite of the fact that groundbreaking researches have been carried out in this realm until now, there are still many novel aspects which have to be explored

Nonholonomic Motion Planning Strategy for Underactuated Manipulator

This paper develops nonholonomic motion planning strategy for three-joint underactuated manipulator, which uses only two actuators and can be converted into chained form. Since the manipulator was designed focusing on the control simplicity, there are several issues for motion planning, mainly including transformation singularity, path estimation, and trajectory robustness in the presence of initial errors, which need to be considered. Although many existing motion planning control laws for chained form system can be directly applied to the manipulator and steer it to desired configuration, coordinate transformation singularities often happen. We propose two mathematical techniques to avoid the transformation singularities. Then, two evaluation indicators are defined and used to estimate control precision and linear approximation capability. In the end, the initial error sensitivity matrix is introduced to describe the interference sensitivity, which is called robustness. The simulation and experimental results show that an efficient and robust resultant path of three-joint underactuated manipulator can be successfully obtained by use of the motion planning strategy we presented