Started data polling and servo writing functions