Changed armCommand to destination so that it passes through the safety node