Fix servo control for Melzi
Merge pull request #637 from justuswilhelm/Marlin_v1

Fix servo control for Melzi v2.0