ekf.c corrections
step_ekf_template.c