Arduino code for ERGo