Added the ability to save RAMPZ and EIND registers (Atmega2560 has it)

Hi Carlos.
I eddited the patch 'cause the Mega2560 has more registers that mus be saved in a context change, here are th corrections