Cleaned up polyhedron a bit and working on scaling matrix