MILP-Based Dual-Arm Motion Planning Considering Shared Transfer Path for Pick-Up and Place

  • Jun Kurosu
  • Ayanori Yorozu
  • Masaki TakahashiEmail author
Conference paper
Part of the Advances in Intelligent Systems and Computing book series (AISC, volume 867)


One of the most basic tasks that a dual-arm robot does is pick-up and place work. Pick-up and place work consists of tasks in which the robot carries objects from a start position (initial position) to a goal position. The following three important points should also be considered when the dual-arm robot does this work efficiently: (1) collision avoidance of the arms, (2) which arm should move an object, and (3) the order in which the objects should be picked up and placed. In addition, dual-arm robot has operation range constraints. Depending on the position relationship between a start position and goal position, unless both arms are used, the object may not be transferred to a goal position. In this paper, we define the transfer path which must use both arms as “shared transfer path”. First, we use mixed integer linear programming (MILP) based planning for the pick-up and place work to determine which arm should move an object and in which order these objects should be moved while considering the dual-arm robot’s operation range. Second, we plan the path using the rapidly exploring random tree (RRT) so that the arms do not collide, enabling the robot to perform efficient pick-up and place work based on the MILP planning solution. The effectiveness of proposed method is confirmed by simulations and experiments using the HIRO dual-arm robot.


Advanced motion planning Manipulator Mixed integer linear programming 



This study was supported by “A Framework PRINTEPS to Develop Practical Artificial Intelligence” of the Core Research for Evolutional Science and Technology (CREST) of the Japan Science and Technology Agency (JST) under Grant Number JPMJCR14E3.


  1. 1.
    Smith, C., Karayiannidis, Y., Nalpantidis, L., Gratal, X., Qi, P., Dimarogonas, D.V., Kragic, D.: Dual arm manipulation – a survey. Robot. Auton. Syst. 60(1), 1340–1353 (2012)CrossRefGoogle Scholar
  2. 2.
    Srivastava, S., Fang, E., Riano, L., Chitnis, R., Russell, S., Abbeel, P.: Combined task and motion planning through an extensible planner-independent interface layer. In: IEEE International Conference on Robotics and Automation (ICRA), pp. 639–646 (2014)Google Scholar
  3. 3.
    Saut, J., Gharbi, M., Corte, J., Sidobre, D., Simeon, T.: Planning pick and place tasks with two-hand regrasping. In: IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 4528–4533 (2010)Google Scholar
  4. 4.
    Huang, Y., Gueta, B., Chiba, R., Arai, T., Ueyama, T., Ota, J.: Selection of manipulator system for multiple-goal task by evaluating task completion time and cost with computational time constraints. Adv. Robot. 27(4), 233–245 (2013)CrossRefGoogle Scholar
  5. 5.
    La Valle, S.M., Kuffer, J.: Randomized kinodynamic planning. Int. J. Robot. Res. 20(5), 378–400 (2001)CrossRefGoogle Scholar
  6. 6.
    Kavraki, L.E., Svestka, P., Latombe, J.-C., Overmars, M.H.: Probabilistic roadmaps for path planning in high-dimensional configuration space. IEEE Trans. Robot. Autom. 12(4), 566–580 (1996)CrossRefGoogle Scholar
  7. 7.
    Kurosu, J., Yorozu, A., Takahashi, M.: Simultaneous dual-arm motion planning for pick-up and place. In: International Conference on Control, Automation and Systems (ICCAS), pp. 80–85 (2016)Google Scholar
  8. 8.
    Kawada Robotics Corporation: “Nextage”. Accessed June 2017
  9. 9.
    Kara, I., Bektas, T.: Integer linear programming formulations of multiple salesman problem and its variations. Eur. J. Oper. Res. 174(3), 1449–1458 (2006)MathSciNetCrossRefGoogle Scholar
  10. 10.
    Bektas, T.: The multiple traveling salesman problem: an overview of formulations and solution procedures. Omega 34(3), 209–219 (2006)MathSciNetCrossRefGoogle Scholar

Copyright information

© Springer Nature Switzerland AG 2019

Authors and Affiliations

  1. 1.Graduate School of Science and TechnologyKeio UniversityKohoku-ku, YokohamaJapan
  2. 2.Department of System Design EngineeringKeio UniversityKohoku-ku, YokohamaJapan

Personalised recommendations