Add example to library

Now includes an example for usage on a Arduino Mega 2560