almost got de-hough math working

checking this in to continue working on different computer.
Some lines are coming out. Others are diagonal for some reason....