Code to move the servo motor

I have provded @hg1001 a functional code.