Add Math library

Math library based on GLM