Sampling-based Motion Planning for Aerial Pick-and-Place

This paper presents a motion planning approach for an aerial pick-and-place task where an aerial manipulator is supposed to pick up or place an object at locations specified as way-points. In particular, we focus on situations where such way-point constraints are imposed on certain partial state variables, rather than on full state variables. Our proposed framework, based on rapidly exploring random trees star (RRT*) in a bidirectional manner, enables an aerial manipulator to find an optimal trajectory that satisfies way-point constraints with only partial specifications. Here, we suggest an extra merging process to integrate the trees, each originated from the start and goal point. In the merging process, we search various candidate points satisfying a given condition that partially constrains state variables, and select a way-point with full specifications optimal in the perspective of the entire trajectory. Simulation and experiment results are included to validate the proposed framework.

[1]  H. Jin Kim,et al.  Planning and Control for Collision-Free Cooperative Aerial Transportation , 2018, IEEE Transactions on Automation Science and Engineering.

[2]  Taewan Kim,et al.  Model predictive control of a multi-rotor with a slung load for avoiding obstacles , 2017, 2017 14th International Conference on Ubiquitous Robots and Ambient Intelligence (URAI).

[3]  H. Jin Kim,et al.  Motion planning with movement primitives for cooperative aerial transportation in obstacle environment , 2017, 2017 IEEE International Conference on Robotics and Automation (ICRA).

[4]  Vincenzo Lippiello,et al.  Cartesian Impedance Control of a UAV with a Robotic Arm , 2012, SyRoCo.

[5]  Siddhartha S. Srinivasa,et al.  Informed RRT*: Optimal sampling-based path planning focused via direct sampling of an admissible ellipsoidal heuristic , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[6]  Rüdiger Dillmann,et al.  RRT∗-Connect: Faster, asymptotically optimal motion planning , 2015, 2015 IEEE International Conference on Robotics and Biomimetics (ROBIO).

[7]  H. Jin Kim,et al.  Path planning and control of multiple aerial manipulators for a cooperative transportation , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[8]  Roland Siegwart,et al.  Fast nonlinear Model Predictive Control for unified trajectory optimization and tracking , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[10]  Marin Kobilarov,et al.  Towards model-predictive control for aerial pick-and-place , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[11]  S. LaValle Rapidly-exploring random trees : a new tool for path planning , 1998 .

[12]  Konstantin Kondak,et al.  First analysis and experiments in aerial manipulation using fully actuated redundant robot arm , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[13]  Richard M. Murray,et al.  A Mathematical Introduction to Robotic Manipulation , 1994 .

[14]  Emilio Frazzoli,et al.  Sampling-based algorithms for optimal motion planning , 2011, Int. J. Robotics Res..