Added NodeHandle to the environment. We will always need one.
Corrected bug in handling of interruptions
Added state machine functions to use Smach in missions
Merge branch 'catkin_groovy' of https://github.com/cedricpradalier/ros_task_manager into catkin_groovy