servo method implemented
servo implement 2