Added toString methods, constructors and a sample geometry method for debugging