Add handed out code for ps1
matrix initialization
Implement like half of the matrix functions and get rid off all errors