EKF2: fix joseph covariance update for Schmidt-Kalman filter #22640

Job	Run time
build (check_format)	1m 6s
build (tests)	5m 46s
build (tests_coverage)	7m 7s
build (px4_fmu-v2_default stack_check)	3m 16s
build (validate_module_configs)	52s
build (shellcheck_all)	1m 42s
build (NO_NINJA_BUILD=1 px4_fmu-v5_default)	4m 16s
build (NO_NINJA_BUILD=1 px4_sitl_default)	3m 26s
build (airframe_metadata)	1m 12s
build (module_documentation)	1m 8s
build (parameters_metadata)	1m 12s
	31m 3s

Provide feedback