EKF hotfix: Force all fields to initialized
EKF hotfix: Remove unused variables, use default initializer list for vectors