Goal Space Planning With Reward Shaping