Hola raposu,
has probado a echarle un ojo a la ‘Ground Station’?
segun entiendo tu problema, esta te podria ayudar, si le dices que vaya de un punto A a uno B a una determinada velocidad y elevacion… no lo has pensado nunca?
EDITO: me acabo de fijar que tienes un vision! por lo visto la nueva app del vision que esta en camino (dicen q de unos dias a una semana, q se fie quien quiera xD) trae ‘integrada’ una especie de ground station. Te recomendaria que esperases un poco a probar esa nueva version, y ver si resuelve tus necesidades.
Un saludo