Arduino code

Not complete