Перенос и объяснение алгоритма из Matlab в С/С++ по ЦОС

Есть алгоритм по демодуляции сигнала в Матлабе. А также детектированию определенных составляющих сигнала. 

Сигнал - ЭКГ. 

Вот список функций использованных в алгоритме : filter, firpm, zeros, angle, conj

Нужна помощь в переносе этого алгоритма на C/C++. Но перенести надо не просто сгенерировать код через Matlab Coder, а так чтобы разобрать можно было

Предложения по поводу улучшения алгоритма также приветствуются.