Add native servo library.
Also add map() to mathutils.h: Re-maps a number from one range to another.
Cut 'n paste of arduino..