Distributed computation and control of robot motion dynamics on FPGAs

Driven by advances in miniaturized electronics, many robotic systems today consist of modular hardware components. This leads to numerous computing units that are distributed within such systems. In order to make better use of such hardware structures from a computational point of view, the implementation of classical control approaches should be reconsidered. Following this idea, a method for distributed computation of motion dynamics of robotic systems using Field Programmable Gate Arrays is discussed. In this approach, local low-level actuator controllers are regarded as interconnected nodes, which are aware of their actuated degree of freedom and the resulting motion of the attached rigid body link element. A modified recursive Newton–Euler algorithm is computed by these nodes, where each node only exchanges data with the neighboring nodes. In the computations, a linear dependency on the dynamic parameters is kept in order to simplify the direct use of dynamic parameters estimated from experimental data. Implementation details and experimental results using a robotic manipulator arm are presented. The experiments show that the method allows compliant motion control. Payloads and external forces acting on a link are considered in the distributed computation of the model by informing the node controlling the respective link of the additional forces.

[1]  Jan Swevers,et al.  Optimal robot excitation and identification , 1997, IEEE Trans. Robotics Autom..

[2]  Rodney A. Brooks,et al.  A Robust Layered Control Syste For A Mobile Robot , 2022 .

[3]  Christopher G. Atkeson,et al.  Estimation of Inertial Parameters of Manipulator Loads and Links , 1986 .

[4]  Rolf Findeisen,et al.  Modeling, parameter identification and model-based control of a lightweight robotic manipulator , 2013, 2013 IEEE International Conference on Control Applications (CCA).

[5]  Adrien Escande,et al.  Identification of fully physical consistent inertial parameters using optimization on manifolds , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[6]  Dong Sun,et al.  Development of an FPGA-Based Motion Control ASIC for Robotic Manipulators , 2006, 2006 6th World Congress on Intelligent Control and Automation.

[7]  Serge Kernbach,et al.  On Adaptive Self-Organization in Artificial Robot Organisms , 2009, 2009 Computation World: Future Computing, Service Computation, Cognitive, Adaptive, Content, Patterns.

[8]  Jean-Jacques E. Slotine,et al.  Robot analysis and control , 1988, Autom..

[9]  Michel Verhaegen,et al.  Distributed Control for Identical Dynamically Coupled Systems: A Decomposition Approach , 2009, IEEE Transactions on Automatic Control.

[10]  Peter Eberhard,et al.  Hierarchical modeling in multibody dynamics , 1998 .

[11]  Arne Wahrburg,et al.  Motor-Current-Based Estimation of Cartesian Contact Forces and Torques for Robotic Manipulators and Its Application to Force Control , 2018, IEEE Transactions on Automation Science and Engineering.

[12]  J. L. Turney,et al.  Equivalence of two formulations for robot arm dynamics , 1980 .

[13]  Chien-Liang Fok,et al.  Actuator Control for the NASA‐JSC Valkyrie Humanoid Robot: A Decoupled Dynamics Approach for Torque Control of Series Elastic Robots , 2015, J. Field Robotics.

[14]  R. Rajagopalan Distributed computation of inverse dynamics of robots , 1996, Proceedings of 3rd International Conference on High Performance Computing (HiPC).

[15]  Thomas Schmickl,et al.  Open-ended on-board Evolutionary Robotics for robot swarms , 2009, 2009 IEEE Congress on Evolutionary Computation.

[16]  Brian S. R. Armstrong,et al.  Dynamics for robot control: friction modeling and ensuring excitation during parameter identification , 1988 .

[17]  Toshiyuki Murakami,et al.  Torque sensorless control in multidegree-of-freedom manipulator , 1993, IEEE Trans. Ind. Electron..

[18]  Thomas M. Roehr,et al.  Modular payload-items for payload-assembly and system enhancement for future planetary missions , 2018, 2018 IEEE Aerospace Conference.

[19]  Olivier Stasse,et al.  Implementing Torque Control with High-Ratio Gear Boxes and Without Joint-Torque Sensors , 2016, Int. J. Humanoid Robotics.

[20]  Jan Swevers,et al.  Experimental robot identification using optimized periodic trajectories , 1994 .

[21]  Minjeong Kim,et al.  Cartesian sensor-less force control for industrial robots , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[22]  Carme Torras,et al.  External force estimation during compliant robot manipulation , 2013, 2013 IEEE International Conference on Robotics and Automation.

[23]  M. Botvinick,et al.  Hierarchically organized behavior and its neural foundations: A reinforcement learning perspective , 2009, Cognition.

[24]  James C. Spall,et al.  Introduction to Stochastic Search and Optimization. Estimation, Simulation, and Control (Spall, J.C. , 2007 .

[25]  Frank Kirchner,et al.  Development of an Intelligent Joint Actuator Prototype for Climbing and Walking Robots , 2009 .

[26]  John J. Craig,et al.  Introduction to Robotics Mechanics and Control , 1986 .

[27]  Gerd Hirzinger,et al.  Robot excitation trajectories for dynamic parameter estimation using optimized B-splines , 2012, 2012 IEEE International Conference on Robotics and Automation.

[28]  Wisama Khalil,et al.  Modeling, Identification and Control of Robots , 2003 .

[29]  John M. Hollerbach,et al.  A Recursive Lagrangian Formulation of Maniputator Dynamics and a Comparative Study of Dynamics Formulation Complexity , 1980, IEEE Transactions on Systems, Man, and Cybernetics.

[30]  Ye Zhao,et al.  Stability and Performance Limits of Latency-Prone Distributed Feedback Controllers , 2015, IEEE Transactions on Industrial Electronics.

[31]  Shanzhong Duan,et al.  Parallel Implementation of a Low Order Algorithm for Dynamics of Multibody Systems on a Distributed Memory Computing System , 2000, Engineering with Computers.

[32]  Ye Zhao,et al.  Distributed Impedance Control of Latency-Prone Robotic Systems with Series Elastic Actuation , 2018, Stability, Control and Application of Time-delay Systems.

[33]  David E. Orin,et al.  Kinematic and kinetic analysis of open-chain linkages utilizing Newton-Euler methods , 1979 .

[34]  Geir E. Dullerud,et al.  Distributed control design for spatially interconnected systems , 2003, IEEE Trans. Autom. Control..

[35]  Jean-Jacques E. Slotine,et al.  Linear Matrix Inequalities for Physically Consistent Inertial Parameter Identification: A Statistical Perspective on the Mass Distribution , 2017, IEEE Robotics and Automation Letters.

[36]  M. Gautier,et al.  Exciting Trajectories for the Identification of Base Inertial Parameters of Robots , 1992 .

[37]  Maxime Gautier,et al.  New criteria of exciting trajectories for robot identification , 1993, [1993] Proceedings IEEE International Conference on Robotics and Automation.

[38]  Ronald C. Arkin,et al.  An Behavior-based Robotics , 1998 .

[39]  J. De Schutter,et al.  Dynamic Model Identification for Industrial Robots , 2007, IEEE Control Systems.

[40]  Oussama Khatib,et al.  Springer Handbook of Robotics , 2007, Springer Handbooks.