Simple Generic Planner ROS components

This subscribes to planning event, and in a callback gets the planning 
environment and problem info. 

ToDo: Add the ompl code