Added the matching reconstruct function (Rs & Ts)