Ozadr1an

This is a remerge with latest Marlin. I merged it to my own fork of your repo. I flashed it to my printer and everything works, so if you could also have a look it would be great... And I would then propagate it to Lawsy's repo, so we can keep everything aligned. I am a bit concerned about the fragmentation of our community firmware, I think we should work towards the reunification, what do you think?