Springen denn die LEDs um?

Wenn ja, hast Du schon mal versucht, das Servo mit einer einfacheren Testroutine zum Drehen zu bewegen?
Ohne Ahnung von Arduino zu haben, die folgende Zeile aus dem Quellcode …

servoblau.write(90); //Servo zum verriegeln auf 90 Grad ansteuern.

… schreit doch förmlich danach, mal zusammen mit einem delay() in einer einfacheren Form ausprobiert zu werden. Dann wüsste man zumindest, ob sich das Servo überhaupt jemals dreht.