Support Scara for marlin

Porting from https://github.com/ttsalo/Marlin-SCARA