Updated Arduino Code and Libraries

- Few code optimizations
- Removed unused "Test" library
- Updated default Code to be uploaded