Whole-Body MPC for a Dynamically Stable Mobile Manipulator

Autonomous mobile manipulation offers a dual advantage of mobility provided by a mobile platform and dexterity afforded by the manipulator. In this paper, we present a whole-body optimal control framework to jointly solve the problems of manipulation, balancing and interaction as one optimization problem for an inherently unstable robot. The optimization is performed using a Model Predictive Control (MPC) approach; the optimal control problem is transcribed at the end-effector space, treating the position and orientation tasks in the MPC planner, and skillfully planning for end-effector contact forces. The proposed formulation evaluates how the control decisions aimed at end-effector tracking and environment interaction will affect the balance of the system in the future. We showcase the advantages of the proposed MPC approach on the example of a ball-balancing robot with a robotic manipulator and validate our controller in hardware experiments for tasks such as end-effector pose tracking and door opening

Contact aware robust semi-autonomous teleoperation of mobile manipulators

In the context of human-robot collaboration, cooperation and teaming, the use of mobile manipulators is widespread on applications involving unpredictable or hazardous environments for humans operators, like space operations, waste management and search and rescue on disaster scenarios. Applications where the manipulator's motion is controlled remotely by specialized operators. Teleoperation of manipulators is not a straightforward task, and in many practical cases represent a common source of failures. Common issues during the remote control of manipulators are: increasing control complexity with respect the mechanical degrees of freedom; inadequate or incomplete feedback to the user (i.e. limited visualization or knowledge of the environment); predefined motion directives may be incompatible with constraints or obstacles imposed by the environment. In the latter case, part of the manipulator may get trapped or blocked by some obstacle in the environment, failure that cannot be easily detected, isolated nor counteracted remotely. While control complexity can be reduced by the introduction of motion directives or by abstraction of the robot motion, the real-time constraint of the teleoperation task requires the transfer of the least possible amount of data over the system's network, thus limiting the number of physical sensors that can be used to model the environment. Therefore, it is of fundamental to define alternative perceptive strategies to accurately characterize different interaction with the environment without relying on specific sensory technologies. In this work, we present a novel approach for safe teleoperation, that takes advantage of model based proprioceptive measurement of the robot dynamics to robustly identify unexpected collisions or contact events with the environment. Each identified collision is translated on-the-fly into a set of local motion constraints, allowing the exploitation of the system redundancies for the computation of intelligent control laws for automatic reaction, without requiring human intervention and minimizing the disturbance of the task execution (or, equivalently, the operator efforts). More precisely, the described system consist in two different building blocks. The first, for detecting unexpected interactions with the environment (perceptive block). The second, for intelligent and autonomous reaction after the stimulus (control block). The perceptive block is responsible of the contact event identification. In short, the approach is based on the claim that a sensorless collision detection method for robot manipulators can be extended to the field of mobile manipulators, by embedding it within a statistical learning framework. The control deals with the intelligent and autonomous reaction after the contact or impact with the environment occurs, and consist on an motion abstraction controller with a prioritized set of constrains, where the highest priority correspond to the robot reconfiguration after a collision is detected; when all related dynamical effects have been compensated, the controller switch again to the basic control mode

Coordinated Control of a Mobile Manipulator

In this technical report, we investigate modeling, control, and coordination of mobile manipulators. A mobile manipulator in this study consists of a robotic manipulator and a mobile platform, with the manipulator being mounted atop the mobile platform. A mobile manipulator combines the dextrous manipulation capability offered by fixed-base manipulators and the mobility offered by mobile platforms. While mobile manipulators offer a tremendous potential for flexible material handling and other tasks, at the same time they bring about a number of challenging issues rather than simply increasing the structural complexity. First, combining a manipulator and a platform creates redundancy. Second, a wheeled mobile platform is subject to nonholonomic constraints. Third, there exists dynamic interaction between the manipulator and the mobile platform. Fourth, manipulators and mobile platforms have different bandwidths. Mobile platforms typically have slower dynamic response than manipulators. The objective of the thesis is to develop control algorithms that effectively coordinate manipulation and mobility of mobile manipulators. We begin with deriving the motion equations of mobile manipulators. The derivation presented here makes use of the existing motion equations of manipulators and mobile platforms, and simply introduces the velocity and acceleration dependent terms that account for the dynamic interaction between manipulators and mobile platforms. Since nonholonomic constraints play a critical role in control of mobile manipulators, we then study the control properties of nonholonomic dynamic systems, including feedback linearization and internal dynamics. Based on the newly proposed concept of preferred operating region, we develop a set of coordination algorithms for mobile manipulators. While the manipulator performs manipulation tasks, the mobile platform is controlled to always bring the configuration of the manipulator into a preferred operating region. The control algorithms for two types of tasks - dragging motion and following motion - are discussed in detail. The effects of dynamic interaction are also investigated. To verify the efficacy of the coordination algorithms, we conduct numerical simulations with representative task trajectories. Additionally, the control algorithms for the dragging motion and following motion have been implemented on an experimental mobile manipulator. The results from the simulation and experiment are presented to support the proposed control algorithms