SAE Level 2 ADAS - Controller Design for UW EcoCAR