Changes to Gauss Siedel Function - Jeremy Kim

Now compatible with mass, stiffness, and dampening matrices