added Planner Interface, gridsearchPlanner, unit tests and fsm unit tests. slightly changed package structure