Search-based planning for dual-arm manipulation with upright orientation constraints
A Formal BasisfortheHeuristic Determination of Minimum CostPaths