Changes to work better with the april tags. includes code for stopping and waiting for a better localization, and resuming after finishing the localization