Merging qr planner

Merged qrplanner with astarseed. debugger added to planner and refactoring done in planner.