Round constrained point, fix test

When constraining points to fit the velocity I'm rounding the values so
we don't get crazy decimals in the coordinates.