Small improvements on the ServoOrechestrator
fixed bug with the head-servos in the wrong order (Gael)