Corrected Vertical servo position
Removed useless code and setup horizontal servos