fixed some misc. stuff, code improvements, testing
fixed some misc. stuff, code improvements, testing

AutonomousCarProject/AutonomousCar,AutonomousCarProject/AutonomousCar,AutonomousCarProject/AutonomousCar,AutonomousCarProject/AutonomousCar