Add a 625 Hz FSK shift.
More small changes to the RDFT code but it seems to working even less
than it was before :(