Does my servo have a problem? or is it my code?