Modified LagrangesMethod.rhs() to use _mat_inv_mul

This was a TODO, and is more consistent with the KanesMethod class.