simplified functions by removing c00, c01, uTM, pdoff as passed arguments. All the matrices are sliced afterwards
removed old attempts
implemented torsion, pressure, Sanders NL still has to be checked