Fixed bug - look for start and end points
Added some test for visibility graph