Standardized spacing and formatting
Added some vector and math utility functions.