Snap to Grid

Not working entirely, but does do some snapping.