Here goes my testbench. I hope it helps.