Optimal Control for Articulated Soft Robots

Soft robots can execute tasks with safer interactions. However, control techniques that can effectively exploit the systems' capabilities are still missing. Differential dynamic programming (DDP) has emerged as a promising tool for achieving highly dynamic tasks. But most of the literature deals with applying DDP to articulated soft robots by using numerical differentiation, in addition to using pure feed-forward control to perform explosive tasks. Further, underactuated compliant robots are known to be difficult to control and the use of DDP-based algorithms to control them is not yet addressed. We propose an efficient DDP-based algorithm for trajectory optimization of articulated soft robots that can optimize the state trajectory, input torques, and stiffness profile. We provide an efficient method to compute the forward dynamics and the analytical derivatives of series elastic actuators (SEA)/variable stiffness actuators (VSA) and underactuated compliant robots. We present a state-feedback controller that uses locally optimal feedback policies obtained from DDP. We show through simulations and experiments that the use of feedback is crucial in improving the performance and stabilization properties of various tasks. We also show that the proposed method can be used to plan and control underactuated compliant robots, with varying degrees of underactuation effectively.Comment: 14 pages, 15 figures, IEEE Transaction on Robotics (TRO

On the motion/stiffness decoupling property of articulated soft robots with application to model-free torque iterative learning control

This paper tackles the problem of controlling articulated soft robots (ASRs), i.e., robots with either fixed or variable elasticity lumped at the joints. Classic control schemes rely on high-authority feedback actions, which have the drawback of altering the desired robot softness. The problem of accurate control of ASRs, without altering their inherent stiffness, is particularly challenging because of their complex and hard-to-model nonlinear dynamics. Leveraging a learned anticipatory action, Iterative Learning Control (ILC) strategies do not suffer from these issues. Recently, ILC was adopted to perform position control of ASRs. However, the limitation of position-based ILC in controlling variable stiffness robots is that whenever the robot stiffness profile is changed, a different input action has to be learned. Our first contribution is to identify a wide class of ASRs, whose motion and stiffness adjusting dynamics can be proved to be decoupled. This class is described by two properties that we define: strong elastic coupling - relative to motors and links of the system, and their connections - and homogeneity - relative to the characteristics of the motors. Furthermore, we design a torque-based ILC scheme that, starting from a rough estimation of the system parameters, refines the torque needed for the joint positions tracking. The resulting control scheme requires minimum knowledge of the system. Experiments on variable stiffness robots prove that the method effectively generalizes the iterative procedure w.r.t. the desired stiffness profile and allows good tracking performance. Finally, potential restrictions of the method, e.g., caused by friction phenomena, are discussed

Open Source VSA-CubeBots for Rapid Soft Robot Prototyping

Nowadays, rapid robot prototyping is a desired capability of any robotics laboratory. Combining the speed of 3D plastic printing and the use of custom Open Source electronic hardware/software solutions, our laboratory successfully developed and used tools related to variable impedance robot technology. This paper describes how we capitalized the design and use of one kind of variable stiffness actuators as a modular tool to prototype and test in a quick fashion several robot capabilities. The extension of such a modular tool for rapid prototyping allowed us to use it in several applications and scenarios, including the educational setting, aiming to speed up the gap between theory and practice in robotics. The complete palette of developments of our laboratory in hardware/software as well as some robotic systems applications shown here, are open source and contribute to the Natural Motion Initiative

SoftHand Pro-D: Matching dynamic content of natural user commands with hand embodiment for enhanced prosthesis control

State of the art of hand prosthetics is divided between simple and reliable gripper-like systems and sophisticate hi-tech poly-articular hands which tend to be complex both in their design and for the patient to operate. In this paper, we introduce the idea of decoding different movement intentions of the patient using the dynamic frequency content of the control signals in a natural way. We move a step further showing how this idea can be embedded in the mechanics of an underactuated soft hand by using only passive damping components. In particular we devise a method to design the hand hardware to obtain a given desired motion. This method, that we call of the dynamic synergies, builds on the theory of linear descriptor systems, and is based on the division of the hand movement in a slow and a fast components. We use this method to evolve the design of the Pisa/IIT SoftHand in a prototype prosthesis which, while still having 19 degrees of freedom and just one motor, can move along two different synergistic directions of motion (and combinations of the two), to perform either a pinch or a power grasp. Preliminary experimental results are presented, demonstrating the effectiveness of the proposed design

Implementation and Control of the Velvet Fingers: a Dexterous Gripper with Active Surfaces

Since the introduction of the first prototypes of robotic end-effectors showing manipulation capabilities, much research focused on the design and control of robot hand and grippers. While many studies focus on enhancing the sensing capabilities and motion agility, a less explored topic is the engineering of the surfaces that enable the hand to contact the object. In this paper we present the prototype of the Velvet Fingers smart gripper, a novel concept of end-effector combining the simple mechanics and control of under-actuated devices together with high manipulation possibilities, usually offered only by dexterous robotic hands. This enhancement is obtained thanks to active surfaces, i.e. engineered contact surfaces able to emulate different levels of friction and to apply tangential thrusts to the contacted object. Through the paper particular attention is dedicated to the mechanical implementation, sense drive and control electronics of the device; some analysis on the control algorithms are reported. Finally, the capabilities of the prototype are showed through preliminary grasps and manipulation experiment

Online Optimal Impedance Planning for Legged Robots

Real world applications require robots to operate in unstructured environments. This kind of scenarios may lead to unexpected environmental contacts or undesired interactions, which may harm people or impair the robot. Adjusting the behavior of the system through impedance control techniques is an effective solution to these problems. However, selecting an adequate impedance is not a straightforward process. Normally, robot users manually tune the controller gains with trial and error methods. This approach is generally slow and requires practice. Moreover, complex tasks may require different impedance during different phases of the task. This paper introduces an optimization algorithm for online planning of the Cartesian robot impedance to adapt to changes in the task, robot configuration, expected disturbances, external environment and desired performance, without employing any direct force measurements. We provide an analytical solution leveraging the mass-spring-damper behavior that is conferred to the robot body by the Cartesian impedance controller. Stability during gains variation is also guaranteed. The effectiveness of the method is experimentally validated on the quadrupedal robot ANYmal. The variable impedance helps the robot to tackle challenging scenarios like walking on rough terrain and colliding with an obstacle

Variable stiffness control for oscillation damping

In this paper a model-free approach for damping control of Variable Stiffness Actuators is proposed. The idea is to take advantage of the possibility to change the stiffness of the actuators in controlling the damping. The problem of minimizing the terminal energy for a one degree of freedom spring-mass model with controlled stiffness is first considered. The optimal bang-bang control law uses a maximum stiffness when the link gets away from the desired position, i.e. the link velocity is decreasing, and a minimum one when the link is going towards it, i.e. the link velocity is increasing. Based on Lyapunov stability theorems the obtained law has been proved to be stable for a multi-DoF system. Finally, the proposed control law has been tested and validated through experimental tests

Modeling Previous Trial Effect in Human Manipulation through Iterative Learning Control

n/

Robust Footstep Planning and LQR Control for Dynamic Quadrupedal Locomotion

In this paper, we aim to improve the robustness of dynamic quadrupedal locomotion through two aspects: 1) fast model predictive foothold planning, and 2) applying LQR to projected inverse dynamic control for robust motion tracking. In our proposed planning and control framework, foothold plans are updated at 400 Hz considering the current robot state and an LQR controller generates optimal feedback gains for motion tracking. The LQR optimal gain matrix with non-zero off-diagonal elements leverages the coupling of dynamics to compensate for system underactuation. Meanwhile, the projected inverse dynamic control complements the LQR to satisfy inequality constraints. In addition to these contributions, we show robustness of our control framework to unmodeled adaptive feet. Experiments on the quadruped ANYmal demonstrate the effectiveness of the proposed method for robust dynamic locomotion given external disturbances and environmental uncertainties