Fix infinite climb bug when using EK3_OGN_HGT_MASK #38743

Job	Run time
build (stm32f7, chibios, 10)	6m 9s
build (stm32h7, chibios, 10)	5m 28s
build (fmuv2-plane, chibios, 10)	1m 57s
build (periph-build, chibios, 10)	4m 11s
build (iofirmware, chibios, 10)	1m 23s
build (CubeOrange-bootloader, chibios, 10)	55s
build (fmuv3-bootloader, chibios, 10)	54s
build (revo-bootloader, chibios, 10)	49s
build (stm32h7-debug, chibios, 10)	3m 31s
build (fmuv3, chibios, 10)	8m 25s
build (revo-mini, chibios, 10)	6m 32s
build (MatekF405-Wing, chibios, 10)	7m 13s
build (CubeOrange-ODID, chibios, 10)	4m 31s
build (CubeRedPrimary-bootloader, chibios, 10)	51s
build (configure-all, chibios, 10)	9m 42s
build (build-options-defaults-test, chibios, 10)	10m 31s
build (signing, chibios, 10)	3m 37s
build (CubeOrange-PPP, chibios, 10)	3m 20s
build (SOHW, chibios, 10)	5m 36s
build (Pixhawk6X-PPPGW, chibios, 10)	1m 29s
	1h 27m 4s

Provide feedback