Added handy overloaded printVector function to print one or two dimensional vectors
Calculated theta and phi (edge orientation and helper angle)
Started working on calculating the size of the edges. Right now the distance appears to be somewhere between inf and -inf