Robust Execution of Contact-Rich Motion Plans by Hybrid Force-Velocity Control

In hybrid force-velocity control, the robot can use velocity control in some directions to follow a trajectory, while performing force control in other directions to maintain contacts with the environment regardless of positional errors. We call this way of executing a trajectory hybrid servoing. We propose an algorithm to compute hybrid force-velocity control actions for hybrid servoing. We quantify the robustness of a control action and make trade-offs between different requirements by formulating the control synthesis as optimization problems. Our method can efficiently compute the dimensions, directions and magnitudes of force and velocity controls. We demonstrated by experiments the effectiveness of our method in several contact-rich manipulation tasks. Link to the video: https://youtu.be/KtSNmvwOenM.Comment: Proceedings of IEEE International Conference on Robotics and Automation (ICRA2019

Controlling under-actuated robot arms using a high speed dynamics process

The invention controls an under-actuated manipulator by first obtaining predetermined active joint accelerations of the active joints and the passive joint friction forces of the passive joints, then computing articulated body qualities for each of the joints from the current positions of the links, and finally computing from the articulated body qualities and from the active joint accelerations and the passive joint forces, active joint forces of the active joints. Ultimately, the invention transmits servo commands to the active joint forces thus computed to the respective ones of the joint servos. The computation of the active joint forces is accomplished using a recursive dynamics algorithm. In this computation, an inward recursion is first carried out for each link, beginning with the outermost link in order to compute the residual link force of each link from the active joint acceleration if the corresponding joint is active, or from the known passive joint force if the corresponding joint is passive. Then, an outward recursion is carried out for each link in which the active joint force is computed from the residual link force if the corresponding joint is active or the passive joint acceleration is computed from the residual link force if the corresponding joint is passive

Integration of Riemannian Motion Policy and Whole-Body Control for Dynamic Legged Locomotion

In this paper, we present a novel Riemannian Motion Policy (RMP)flow-based whole-body control framework for improved dynamic legged locomotion. RMPflow is a differential geometry-inspired algorithm for fusing multiple task-space policies (RMPs) into a configuration space policy in a geometrically consistent manner. RMP-based approaches are especially suited for designing simultaneous tracking and collision avoidance behaviors and have been successfully deployed on serial manipulators. However, one caveat of RMPflow is that it is designed with fully actuated systems in mind. In this work, we, for the first time, extend it to the domain of dynamic-legged systems, which have unforgiving under-actuation and limited control input. Thorough push recovery experiments are conducted in simulation to validate the overall framework. We show that expanding the valid stepping region with an RMP-based collision-avoidance swing leg controller improves balance robustness against external disturbances by up to $53\%$ compared to a baseline approach using a restricted stepping region. Furthermore, a point-foot biped robot is purpose-built for experimental studies of dynamic biped locomotion. A preliminary unassisted in-place stepping experiment is conducted to show the viability of the control framework and hardware

Null-Space Minimization of Center of Gravity Displacementof a Redundant Aerial Manipulator

Displacements of the base during trajectory tracking are a common issue in the control of aerial manipulators. These are caused by reaction torques transferred to the base due to the manipulator motion and, in particular, to the motion of its center of gravity. We present a novel approach to reduce base displacements of a kinematically redundant aerial manipulator by using null-space projection in the inverse kinematic control. A secondary objective function minimizes the horizontal displacement of the manipulator center of gravity. We test this algorithm on different trajectories for both three and four degrees of freedom (DOF) manipulators in a simulation environment. The results comparing our algorithm with inverse kinematic control without the null-space projection show up to an 80% reduction in the end-effector position error and an average of about 56% reduction in maximum base displacement. The simulation implementation also runs faster than in real-time in our code implementation. We provide a workspace analysis based on multiple stopping criteria such as excessive base displacement, joint velocities and end-effector position error for the 3 and 4 DOF manipulators. As expected, the 4 DOF manipulator has a larger workspace

The power dissipation method and kinematic reducibility of multiple-model robotic systems

This paper develops a formal connection between the power dissipation method (PDM) and Lagrangian mechanics, with specific application to robotic systems. Such a connection is necessary for understanding how some of the successes in motion planning and stabilization for smooth kinematic robotic systems can be extended to systems with frictional interactions and overconstrained systems. We establish this connection using the idea of a multiple-model system, and then show that multiple-model systems arise naturally in a number of instances, including those arising in cases traditionally addressed using the PDM. We then give necessary and sufficient conditions for a dynamic multiple-model system to be reducible to a kinematic multiple-model system. We use this result to show that solutions to the PDM are actually kinematic reductions of solutions to the Euler-Lagrange equations. We are particularly motivated by mechanical systems undergoing multiple intermittent frictional contacts, such as distributed manipulators, overconstrained wheeled vehicles, and objects that are manipulated by grasping or pushing. Examples illustrate how these results can provide insight into the analysis and control of physical systems