ServoOrchestrator - start/goal-updates & fixes