Update simplekalman.m