Modified firmware to include timeout for ardunino, implemented basic wall follower