It is very simple to implement BFSK De-modulator you have to make two filters and diode detectors. What you can do implement the design on simulink and generate its code.
Generate 1 for binary 1 and i for binary 0, add complex noise, and decide 1 if the real part of the received signal is greater than the imaginary and vice versa.