Working on making sensor inputs give servo commands