Added Probing to Mega2560 and fixed Shapeoko2 compile error