Add point class with nice toString method
Clean ups