Initial version of higher-level perception functions

Summary
The deliverable provides a report and code on the road perception, terrain mapping, road users and signaling perception functions and their design, implementation and evaluation. It also provides sensor fusion based perception refinement and environment model design, implementation and evaluation.