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

Also, I guess that the first pass (not working all the way yet) Fubarino SDZ variant support is in this pull request as well. Didn't really mean to do that, but I'm not sure how to back that out.