Prevent undefined moves - C2 limits

This will prevent undefined moves in SCARA kinematics, regardless of the size of the system.