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

(cherry picked from commit 001281e45fcb0a2ef89d8f149776f41ae867731a)
The same improvment but for this other branch