Added Probing to Mega2560 and fixed Shapeoko2 compile error

Added Probing to Mega2560
Fixed Shapeoko2 compile error

Sorry, I dont know why it has picked up the pull request from henlos.