fix: uninitialized matrix prevented kalman filter from working properly