Almost done with initialization

Includes preceding vehicle but is missing traffic light capability.