init commit

first working servo control thing
some hidden features