Least squares solver

I had to refactor the existing HouseholderQR as well.