V2.0 Arduino code

finished code waiting for testing to solve bugs