Fixed the bug with servo1