integrating chamnit's grbl-edge's math