Create a new firmware

Actually according my project, I have to read data from radar, but this one react like low-pass filter of second order with 2 or 3 seconds for stabilization (like in the picture calls original). I developed a Matlab script in order to display mean (like in the picture, with red curb, calls filtered). I learned then I do the same thing on Mission Planner if I modify the firmware but the server proposed but Ardupilot isn’t in accord with my problem. So I ask this question, is it a file then I can modify data acquisition from serial port ?
the picture are on the link bellow : measure - Google Drive