T2 finished. Added testbench.