Implemented SCARA-Maths

Tested and reviewed by father of REPRAP Scara Quinton Harley
You are right... My fault.....