Added expand vector function, added more lines to classical GMRES