Fixed servo alarm management
Merge pull request #230 from fabienrohrer/master

Fixed servo alarm management