Fixed a closure bug in PolytopeIntersector that made the intersector get the wrong points. More misc fixes