Copter: RTL with rally point finds shortest path using Dijkstras (WIP) #43673

Job	Run time
build (stm32f7, chibios, 10)	9m 57s
build (stm32h7, chibios, 10)	9m 7s
build (fmuv2-plane, chibios, 10)	5m 19s
build (periph-build, chibios, 10)	5m 49s
build (iofirmware, chibios, 10)	3m 51s
build (CubeOrange-bootloader, chibios, 10)	3m 22s
build (fmuv3-bootloader, chibios, 10)	3m 9s
build (revo-bootloader, chibios, 10)	3m 21s
build (stm32h7-debug, chibios, 10)	6m 36s
build (fmuv3, chibios, 10)	12m 47s
build (revo-mini, chibios, 10)	9m 58s
build (MatekF405-Wing, chibios, 10)	10m 21s
build (CubeOrange-ODID, chibios, 10)	7m 40s
build (CubeRedPrimary-bootloader, chibios, 10)	3m 3s
build (configure-all, chibios, 10)	13m 10s
build (build-options-defaults-test, chibios, 10)	9m 50s
build (signing, chibios, 10)	6m 39s
build (CubeOrange-PPP, chibios, 10)	6m 1s
build (CubeRed-EKF2, chibios, 10)	6m 8s
build (SOHW, chibios, 10)	8m 48s
build (Pixhawk6X-PPPGW, chibios, 10)	3m 24s
build (new-check, chibios, 10)	11m 17s
	2h 39m 37s

Provide feedback