I finally managed to figure out the algorithm to calculate the points snapped to the grid, after a lot of trial and error c: