Added some line and point utility functions to mathutil, plus structs