Update snKalman.cpp