I have the position checking and ortho to iso algorithm working