Got the servo demo working.