Adding preliminary implementation of TSQR