added tex template
finished vehicle algorithms
before Look-Ahead