Fixed bugs in servo controller