Auto revamp

Redesign of floor start and implementation of drift/obstacle detection.
also added a pole knock down function to floor start