Adding basic servo control through servoblaster