MPTP: Motion-planning-aware task planning for navigation in belief space