Using the enable pin to stop and start isn't really a good idea. Steppers should be accelerated and decelerated to run smoothly. Consider using a library to generate the steps for your motors.
If you use my MobaTools library, you can also control your servos with it, and all is done via timer 1 without disturbing each other. You can also set the speed for servo movement, so you don't need your for loops to do that anymore.