Speed PI control for a servo HS-55 feather hitec

hello, I need some help in my school in the control class left me a task to perform PI speed controller for a feather servo Hitec HS-55, but I have very basic programming knowledge, and I hope you can help me :)