Fix servo control for Melzi v2.0

This allows using servos on the spare IO pins that the Melzi board has.