Add custom M code for changing Z probe offset

Refactored code values into Configuration.h
Change custom M-code numerical values to not conflict with any documented codes
add tests for custom M codes