Added some math vector/matrix functions