САЕП - фільтр калмана. Ще допрацювати потрібно і код і питання у протоколі