initialization working on arduino side.
Merge pull request #10 from benkahle/81133082

Initialization routine