Add trmv and test_trmv