Added a 2nd servo to control