Adding init/test/plotting for environment
Adding utilsmath for common utilities