updated seidel solver

B matrix only contained force vector before but now b vector is equal to
the sum of G1, G2, and B. The B variable initially is the force vector
that was passed in