Real-time motion planning of robots in a dynamic environment requires a continuous evaluation of the determined trajectory so as to avoid moving obstacles. This is even more challenging when the robot also needs to perform a task optimally while avoiding the obstacles due to the limited time available for generating a new collision-free path. In this paper, we propose the sequential expanded Lagrangian homotopy (SELH) approach, which is capable of determining the globally optimal robot's motion sequentially while satisfying the task constraints. Through numerical simulations, we demonstrate the capabilities of the approach by planning an optimal motion of a redundant mobile manipulator performing a complex trajectory. Comparison against existing optimal motion planning approaches, such as genetic algorithm (GA) and neural network (NN), shows that SELH is able to perform the planning at a faster rate. The considerably short computational time opens up an opportunity to apply this method in real time; and since the robot's motion is planned sequentially, it can also be adjusted to accommodate for dynamically changing constraints such as moving obstacles.
Issue Section:
Research Papers
References
1.
Stilman
, M.
, 2010
, “Global Manipulation Planning in Robot Joint Space With Task Constraints
,” IEEE Trans. Rob.
, 26
(3
), pp. 576
–584
.2.
Dharmawan
, A. G.
, Sedore
, B. W. C.
, Soh
, G. S.
, Foong
, S.
, and Otto
, K.
, 2015
, “Robot Base Placement and Kinematic Evaluation of 6R Serial Manipulators to Achieve Collision-Free Welding of Large Intersecting Cylindrical Pipes,” ASME
Paper No. DETC2015-47038.3.
Whitney
, D. E.
, 1969
, “Resolved Motion Rate Control of Manipulators and Human Prostheses
,” IEEE Trans. Man-Mach. Syst.
, 10
(2
), pp. 47
–53
.4.
Wampler
, C. W.
, 1986
, “Manipulator Inverse Kinematic Solutions Based on Vector Formulations and Damped Least-Squares Methods
,” IEEE Trans. Syst. Man Cybern.
, 16
(1
), pp. 93
–101
.5.
Chan
, T. F.
, and Dubey
, R. V.
, 1995
, “A Weighted Least-Norm Solution Based Scheme for Avoiding Joint Limits for Redundant Joint Manipulators
,” IEEE Trans. Rob. Autom.
, 11
(2
), pp. 286
–292
.6.
Xiang
, J.
, Zhong
, C.
, and Wei
, W.
, 2010
, “General-Weighted Least-Norm Control for Redundant Manipulators
,” IEEE Trans. Rob.
, 26
(4
), pp. 660
–669
.7.
Liegeois
, A.
, 1977
, “Automatic Supervisory Control of the Configuration and Behavior of Multibody Mechanisms
,” IEEE Trans. Syst. Man Cybern.
, 7
(12
), pp. 868
–871
.8.
Maciejewski
, A. A.
, and Klein
, C. A.
, 1985
, “Obstacle Avoidance for Kinematically Redundant Manipulators in Dynamically Varying Environments
,” Int. J. Rob. Res.
, 4
(3
), pp. 109
–117
.9.
Nakamura
, Y.
, Hanafusa
, H.
, and Yoshikawa
, T.
, 1987
, “Task-Priority Based Redundancy Control of Robot Manipulators
,” Int. J. Rob. Res.
, 6
(2
), pp. 3
–15
.10.
Hollerbach
, J. M.
, and Suh
, K. C.
, 1987
, “Redundancy Resolution of Manipulators Through Torque Optimization
,” IEEE J. Rob. Autom.
, 3
(4
), pp. 308
–316
.11.
Tchon
, K.
, 2008
, “Optimal Extended Jacobian Inverse Kinematics Algorithms for Robotic Manipulators
,” IEEE Trans. Rob.
, 24
(6
), pp. 1440
–1445
.12.
Zanchettin
, A. M.
, and Rocco
, P.
, 2012
, “A General User-Oriented Framework for Holonomic Redundancy Resolution in Robotic Manipulators Using Task Augmentation
,” IEEE Trans. Rob.
, 28
(2
), pp. 514
–521
.13.
Nagatani
, K.
, Hirayama
, T.
, Gofuku
, A.
, and Tanaka
, Y.
, 2002
, “Motion Planning for Mobile Manipulator With Keeping Manipulability
,” IEEE/RSJ International Conference on Intelligent Robots and Systems
(IROS
), Lausanne, Switzerland, Sept. 30–Oct. 4, pp. 1663
–1668
.14.
Toogood
, R.
, Hao
, H.
, and Wong
, C.
, 1995
, “Robot Path Planning Using Genetic Algorithms
,” IEEE
International Conference on Systems, Man and Cybernetics
, Vancouver, BC, Canada, Oct. 22–25, pp. 489
–494
.15.
da Graa Marcos
, M.
, Machado
, J. T.
, and Azevedo-Perdicoúlis
, T. P.
, 2010
, “An Evolutionary Approach for the Motion Planning of Redundant and Hyper-Redundant Manipulators
,” Nonlinear Dyn.
, 60
(1–2
), pp. 115
–129
.16.
Menasri
, R.
, Nakib
, A.
, Daachi
, B.
, Oulhadj
, H.
, and Siarry
, P.
, 2015
, “A Trajectory Planning of Redundant Manipulators Based on Bilevel Optimization
,” Appl. Math. Comput.
, 250
, pp. 934
–947
.17.
An
, H. H.
, Clement
, W. I.
, and Reed
, B.
, 2014
, “Analytical Inverse Kinematic Solution With Self-Motion Constraint for the 7-DOF Restore Robot Arm
,” IEEE/ASME International Conference on Advanced Intelligent Mechatronics
(AIM
), Besacon, France, July 8–11, pp. 1325
–1330
.18.
Shimizu
, M.
, Kakuya
, H.
, Yoon
, W. K.
, Kitagaki
, K.
, and Kosuge
, K.
, 2008
, “Analytical Inverse Kinematic Computation for 7-DOF Redundant Manipulators With Joint Limits and Its Application to Redundancy Resolution
,” IEEE Trans. Rob.
, 24
(5
), pp. 1131
–1142
.19.
Luo
, R. C.
, Lin
, T. W.
, and Tsai
, Y. H.
, 2014
, “Analytical Inverse Kinematic Solution for Modularized 7-DoF Redundant Manipulators With Offsets at Shoulder and Wrist
,” IEEE/RSJ International Conference on Intelligent Robots and Systems
(IROS
), Chicago, IL, Sept. 14–18, pp. 516
–521
.20.
Huang
, C. K.
, and Tsai
, K. Y.
, 2015
, “Analytical Inverse Kinematic Computation for a Special Class of 7-DOF Redundant Manipulators
,” 14th IFToMM World Congress
, Taipei, Taiwan, Oct. 25–30, pp. 154
–161
.21.
Toshani
, H.
, and Farrokhi
, M.
, 2014
, “Real-Time Inverse Kinematics of Redundant Manipulators Using Neural Networks and Quadratic Programming: A Lyapunov-Based Approach
,” Rob. Auton. Syst.
, 62
(6
), pp. 766
–781
.22.
Zhang
, Z.
, and Zhang
, Y.
, 2012
, “Acceleration-Level Cyclic-Motion Generation of Constrained Redundant Robots Tracking Different Paths
,” IEEE Trans. Syst. Man Cybern.
, 42
(4
), pp. 1257
–1269
.23.
Rickert
, M.
, Sieverling
, A.
, and Brock
, O.
, 2014
, “Balancing Exploration and Exploitation in Sampling-Based Motion Planning
,” IEEE Trans. Rob.
, 30
(6
), pp. 1305
–1317
.24.
Yao
, Z.
, and Gupta
, K.
, 2006
, “Self-Motion Graph in Path Planning for Redundant Robots Along Specified End-Effector Paths
,” IEEE International Conference on Robotics and Automation
(ICRA
), Barcelona, Spain, Apr. 18–22, pp. 2004
–2009
.25.
Oriolo
, G.
, and Mongillo
, C.
, 2005
, “Motion Planning for Mobile Manipulators Along Given End-Effector Paths
,” IEEE International Conference on Robotics and Automation
(ICRA
), Orlando, FL, May 15–19, pp. 2154
–2160
.26.
Schneider
, D.
, Schomer
, E.
, and Wolpert
, N.
, 2015
, “Completely Randomized RRT-Connect: A Case Study on 3D Rigid Body Motion Planning
,” IEEE International Conference on Robotics and Automation
(ICRA
), Seattle, WA, May 26–30, pp. 2944
–2950
.27.
Arslan
, O.
, and Tsiotras
, P.
, 2015
, “Dynamic Programming Guided Exploration for Sampling-Based Motion Planning Algorithms
,” IEEE International Conference on Robotics and Automation
(ICRA
), Seattle, WA, May 26–30, pp. 4819
–4826
.28.
Campana
, M.
, Lamiraux
, F.
, and Laumond
, J. P.
, 2016
, “A Gradient-Based Path Optimization Method for Motion Planning
,” Adv. Rob.
, 30
(17–18
), pp. 1126
–1144
.29.
Elbanhawi
, M.
, and Simic
, M.
, 2014
, “Sampling-Based Robot Motion Planning: A Review
,” IEEE Access
, 2
, pp. 56
–77
.30.
Dharmawan
, A. G.
, Foong
, S.
, and Soh
, G. S.
, 2016
, “Simultaneous Optimal Robot Base Placement and Motion Planning Using Expanded Lagrangian Homotopy,” ASME
Paper No. DSCC2016-9882.31.
Poore
, A. B.
, and Al-Hassan
, Q.
, 1988
, “The Expanded Lagrangian System for Constrained Optimization Problems
,” SIAM J. Control Optim.
, 26
(2
), pp. 417
–427
.32.
Watson
, L. T.
, and Haftka
, R. T.
, 1989
, “Modern Homotopy Methods in Optimization
,” Comput. Methods Appl. Mech. Eng.
, 74
(3
), pp. 289
–305
.33.
Yoshikawa
, T.
, 1985
, “Manipulability of Robotic Mechanisms
,” Int. J. Rob. Res.
, 4
(2
), pp. 3
–9
.34.
Tang
, B.
, Chen
, T.
, and Atkeson
, C. G.
, 2015
, “Humanoid Full-Body Manipulation Planning With Multiple Initial Guesses and Key Postures
,” IEEE/RSJ International Conference on Intelligent Robots and Systems
(IROS
), Hamburg, Germany, Sept. 28–Oct. 2, pp. 6395
–6401
.35.
Chiang
, H. T.
, Malone
, N.
, Lesser
, K.
, Oishi
, M.
, and Tapia
, L.
, 2015
, “Path-Guided Artificial Potential Fields With Stochastic Reachable Sets for Motion Planning in Highly Dynamic Environments
,” IEEE International Conference on Robotics and Automation
(ICRA
), Seattle, WA, May 26–30, pp. 2347
–2354
.36.
Kim
, S.
, and Likhachev
, M.
, 2015
, “Path Planning for a Tethered Robot Using Multi-Heuristic A* With Topology-Based Heuristics
,” IEEE/RSJ International Conference on Intelligent Robots and Systems
(IROS
), Hamburg, Germany, Sept. 28–Oct. 2, pp. 4656
–4663
.37.
Brock
, O.
, and Khatib
, O.
, 2002
, “Elastic Strips: A Framework for Motion Generation in Human Environments
,” Int. J. Rob. Res.
, 21
(12
), pp. 1031
–1052
.38.
Ratliff
, N.
, Zucker
, M.
, Bagnell
, J. A.
, and Srinivasa
, S.
, 2009
, “CHOMP: Gradient Optimization Techniques for Efficient Motion Planning
,” IEEE International Conference on Robotics and Automation (ICRA)
, pp. 489
–494
.39.
Universal Robots A/S, 2018, “UNIVERSAL ROBOTS UR10,” Universal Robots A/S, Odense, Denmark, accessed Feb. 27, 2018, https://www.universal-robots.com/products/ur10-robot/
40.
ABB, 2018, “IRB 1410,” ABB, Baden-Dättwil, Switzerland, accessed Feb. 27, 2018, http://new.abb.com/products/robotics/industrial-robots/irb-1410
Copyright © 2018 by ASME
You do not currently have access to this content.
