Merge pull request #517 from EmbeddedMan/master

Fix for issue #516 - Servo library not working on MX1/MX2 parts.