making robot navigate to Way Point always when the first action is not move_base type