Code for controlling Futaba S3003 servos with an NXP P89V660/662/664 board