tried low pass filter, but didnt work out, now trying out simplyfied kalman approach