Matlap Simulink Ortamında Sensör Sinyal İşleme ve Veri Ortalama Alma

Merhaba,
İMU sensörden gelen verileri lowpas ve birkaç filtreden geçirdim ancak oluşan bazı peak'leri önleyemedim. Sensör verilerini simulink ortamında okuyorum. Gelen verilerin ortalamasını alarak büyük verileri çıkartarak bir nevi filtreleme yapmayı düşünüyorum. Simulink ortamında s-function bloğunu kullanarak "smoothing" gibi bir kaç "C" kodu yazmaya çalıştım ancak hep tanımsız fonksiyon değer gibi hatalar aldım bu kodlarda.Özellikler sensör sinyal filtreleme ile uğraşmış arkadaşlar tecrübelerini ve  Bu konuyla alakalı bilgisi olan arkadaşlar  bir fikir yöntem verirseniz memnun olurum. Herkese iyi çalışmalar dilerim.