M206 working

Code to enable M206 command on the Nophead Mendel90. Taken from JM
Giacalone on the RepRapPro github for their Huxley machine