Made some changes for Arduino 1.0
Changes are for Arduino 1.0, should work as library with example now
Works well with ArduinoMega2560
Merge pull request #1 from retsifp/master

Slightly changed code for Arduino 1.0