Fixed AVR arch_contextrestore_i which ma cause stack corrupt on very fast
interupts