Added the nodes necessary for the backtracking to monitored_nav.launch