modified code from "Ultimate Starter Kit with Mega 2560 for Arduino" PDF lesson 24:servo motor control test