Added some methods to FullMatrix. Progress on ChorinMethod