Added b vector and updated the K matrix

Added vectorized version of analytical solution FEMb