reverted previous commit

- the fix was not suitable for Arduino Mega board