Added a sub-matrix addition routine and used it for Robin boundary conditions, which have been tested and work. Also, associate statement is used freely now which makes for much more readable code.