Lightweight servo library for Energia (MSP430 Launchpad)