Design And Evaluation Of Perception System Algorithms For Semi-Autonomous Vehicles