Working filter with fixed point in C