Fixed the TRIDIAG function. It now produces the exact same results as the biult in solve function in armadillo. There were some sort of faulty indices.