Added matrix functions for generating the common gl matricies.
Added tests for vector functionality.