Describing Physics For Physical Reasoning: Force-Based Sequential Manipulation Planning

Physical reasoning is a core aspect of intelligence in animals and humans. A central question is what model should be used as a basis for reasoning. Existing work considered models ranging from intuitive physics and physical simulators to contact dynamics models used in robotic manipulation and locomotion. In this work we propose descriptions of physics which directly allow us to leverage optimization methods for physical reasoning and sequential manipulation planning. The proposed multi-physics formulation enables the solver to mix various levels of abstraction and simplifications for different objects and phases of the solution. As an essential ingredient, we propose a specific parameterization of wrench exchange between object surfaces in a path optimization framework, introducing the point-of-attack as decision variable. We demonstrate the approach on various robot manipulation planning problems, such as grasping a stick in order to push or lift another object to a target, shifting and grasping a book from a shelve, and throwing an object to bounce towards a target.

[1]  Marc Toussaint,et al.  Differentiable Physics and Stable Modes for Tool-Use and Manipulation Planning , 2018, Robotics: Science and Systems.

[2]  M. Anitescu,et al.  Formulating Dynamic Multi-Rigid-Body Contact Problems with Friction as Solvable Linear Complementarity Problems , 1997 .

[3]  Adam B. Levy,et al.  Sensitivity of Solutions in Nonlinear Programming Problems with Nonunique Multipliers , 1995 .

[4]  Maria Bauzá,et al.  A Data-Efficient Approach to Precise and Controlled Pushing , 2018, CoRL.

[5]  Leslie Pack Kaelbling,et al.  A constraint-based method for solving sequential manipulation planning problems , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[6]  A. F. Izmailov Solution sensitivity for Karush–Kuhn–Tucker systems with non-unique Lagrange multipliers , 2010 .

[7]  Manuel Lopes,et al.  Multi-bound tree search for logic-geometric programming in cooperative manipulation domains , 2017, 2017 IEEE International Conference on Robotics and Automation (ICRA).

[8]  J. Call,et al.  Space or physics? Children use physical reasoning to solve the trap problem from 2.5 years of age. , 2014, Developmental psychology.

[9]  A. Fiacco,et al.  Sensitivity analysis in nonlinear programming under second order assumptions , 1985 .

[10]  Alessandro Saffiotti,et al.  Constraint propagation on interval bounds for dealing with geometric backtracking , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[11]  Pieter Abbeel,et al.  Combined task and motion planning through an extensible planner-independent interface layer , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[12]  Nima Fazeli,et al.  Parameter and contact force estimation of planar rigid-bodies undergoing frictional contact , 2017, Int. J. Robotics Res..

[13]  Kevin M. Lynch,et al.  Stable Pushing: Mechanics, Controllability, and Planning , 1995, Int. J. Robotics Res..

[14]  Robin Deits,et al.  Footstep planning on uneven terrain with mixed-integer convex optimization , 2014, 2014 IEEE-RAS International Conference on Humanoid Robots.

[15]  Jung-Su Ha,et al.  Deep Visual Heuristics: Learning Feasibility of Mixed-Integer Programs for Manipulation Planning , 2020, 2020 IEEE International Conference on Robotics and Automation (ICRA).

[16]  Zoran Popovic,et al.  Contact-invariant optimization for hand manipulation , 2012, SCA '12.

[17]  A. Kacelnik,et al.  Cognitive Processes Associated with Sequential Tool Use in New Caledonian Crows , 2009, PloS one.

[18]  Daniel J. Povinelli,et al.  Social and physical reasoning in human-reared chimpanzees : preliminary studies , 2011 .

[19]  Jung-Su Ha,et al.  A Probabilistic Framework for Constrained Manipulations and Task and Motion Planning under Uncertainty , 2020, 2020 IEEE International Conference on Robotics and Automation (ICRA).

[20]  J. Andrew Bagnell,et al.  A convex polynomial model for planar sliding mechanics: theory, application, and experimental validation , 2018, Int. J. Robotics Res..

[21]  Jessica B. Hamrick Physical reasoning in complex scenes is sensitive to mass , 2012 .

[22]  Jessica B. Hamrick,et al.  Simulation as an engine of physical scene understanding , 2013, Proceedings of the National Academy of Sciences.

[23]  Yuval Tassa,et al.  MuJoCo: A physics engine for model-based control , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[24]  Marc Toussaint,et al.  Logic-Geometric Programming: An Optimization-Based Approach to Combined Task and Motion Planning , 2015, IJCAI.

[25]  Marc Toussaint A Tutorial on Newton Methods for Constrained Trajectory Optimization and Relations to SLAM, Gaussian Process Smoothing, Optimal Control, and Probabilistic Inference , 2017, Geometric and Numerical Foundations of Movements.

[26]  Jeffrey C. Trinkle,et al.  An implicit time-stepping scheme for rigid body dynamics with Coulomb friction , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[27]  Russ Tedrake,et al.  Direct Trajectory Optimization of Rigid Body Dynamical Systems through Contact , 2012, WAFR.

[28]  Rachid Alami,et al.  Towards Combining HTN Planning and Geometric Task Planning , 2013, ArXiv.

[29]  Alessandro Saffiotti,et al.  Efficiently combining task and motion planning using geometric constraints , 2014, Int. J. Robotics Res..

[30]  Kevin A. Smith,et al.  Different Physical Intuitions Exist Between Tasks, Not Domains , 2018, Computational Brain & Behavior.

[31]  Alberto Rodriguez,et al.  Reactive Planar Manipulation with Convex Hybrid MPC , 2017, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[32]  Jiayin Xie,et al.  Rigid body dynamic simulation with line and surface contact , 2016, 2016 IEEE International Conference on Simulation, Modeling, and Programming for Autonomous Robots (SIMPAR).

[33]  Mathew Halm,et al.  A Quasi-static Model and Simulation Approach for Pushing, Grasping, and Jamming , 2018, WAFR.

[34]  François Osiurak,et al.  Tool use and affordance: Manipulation-based versus reasoning-based approaches. , 2016, Psychological review.