Major refactoring to make it easier to support additional kinematics. Added M669 command to select and configure Scara kinematics