First commit

Works and sends info between 0 and 180 degree. Still buggy, but working
on it