Fix Servo Control Logic those problem from incorrect pin link