Finished code for problem 1, just havent setup the matrix yet and done initial guess. Not sure how to approash number 2 yet...