CoreXY: also calculate motor movement direction correctly.

CoreXY should be complete now.