servo bug fixed