Added test sketch of current features.

This is an Arduino sketch ( C++ ) which test out each feature I have
implemented.