Started math implementation to free program from GLM dependencies