moved FM mod/demod into functions

git-svn-id: https://svn.code.sf.net/p/freetel/code/codec2-dev@1966 01035d8c-6547-0410-b346-abe4f91aad63