aprinter-teensy3-corexy: Fix bad math.