ServoOrchestrator - small fixes