Line Follower: can my code be optimized?