Added hooks, fixed failure handling
Catkinized navigation package and exchanged the navp controller call with CRAM internal controller structure (from cl_control_primitives)

This saves us from the actionlib failures (hangs/freezes) during navigation