servo code

thanks guys you are awsome