Fixes buffer overflow, 1ms/char delay

This should work, done in AtmelStudio so may require some tweaks.