Finished everything assignment 1 except normal equation