added code for trifocal tensor