fpga: Cleanup testbench and testbench build

fpga: Cleanup testbench and testbench build #448