if structure takes too much time

cheesepower:
it take too much time to switch from a mode to another (almost a second approx). To me it is annoying...

I suggest you comment out all the Serial.prints, and all the delays. Does that solve the problem?