CoreXY: get math for delta_um[] right.

Explanation at http://www.corexy.com/theory.html
CoreXY: get math for steps right, too.

Also add some debugging code.