Some tweaks to fine tune servo movements to current mechanism