Towards Efficient and Robust Robot Planning