First complete version

Didn’t test on arduino, wish all well