Math library

Added a very simple Math library for Point, Vector and some utility
functions and classes.