Motion Planning for Manipulation With Heuristic Search