Added Arduino MEGA(2560) boards compatibility

Changed PWM registers for MEGA boards. Board is detected and code adapted at compile time (preprocessor #IF).

Code was confirmed running on Arduino MEGA2560 Rev2.