Implemented plan_route and plan_shot (#872)

* define plan_route, plan_shot and refactor code

* minor changes

* Added PlanRoute Problem class

* update plan_route

return list of actions ( node.solution() ) instead of node itself in plan_route