final code, sans vision and vision autonomous