Added nextPath to handle syncronization problems with mes server.

Tested decision layer, no bugs found.

todo: remove long wait times at state_free_<___>

smachViewer was to simply smach state machine. conclusion: smach_viewer itself is faulty.

Signed-off-by: Lasse Boerresen <fiffigini@gmail.com>
Merge branch 'master' of github.com:RSD2014Group4/FroboMind