Look at my reply #15. You need the curly brackets to enclose the if and else blocks otherwise only the first statement after the if or else is executed conditionally. It works now, but without the brackets, when you uncomment the servo commands the LEDs won't work right. I always use curly brackets to enclose a block, even if it is only one line.