Add testbench

Signed-off-by: crynobone <crynobone@gmail.com>