Visibility graph almost there. Need to deal with boundaries and interior obstacle crossings