adding servo code