Moved navigation stack to Pioneer in g2 -folder
Seems to be working little bit better.
Got states PREEMPTED and LOST from actionlib