initial port from raspberry pi python script to Arduino
This compiles, but is totally untested.
Removed stepper motor control since I can't get it working
Merge branch 'feature/Add_Arduino_Version' into develop