added finish signal and wait time before starting to drive the path