Removed verbose print
ekf: Better variable zeroing