if (midp > sa / 2)
        f_dk = -freq/sa * (sa - midp);
    else
        f_dk = freq/sa * midp;