Fixed small bug in TSQR
Reduced output from main.cpp