Fix some bugs, add 6MHz FIR