fsmcslave: improve testbench, correct FPGA freqeuncy