Add FPS option to Servo

Also throttles FPS and rate so we don't exceed Servo resolution