C ++ Trovare n punti il ​​più vicino possibile a dare XY

Question

Nei giochi RTS, quando muovi alcune unità, trovano il percorso e vanno nei luoghi più vicini al luogo selezionato. Non so come selezionare quei posti, intendo i punti target per ogni unità.

Ad esempio, quando mando 9 truppe, voglio che abbiano obiettivi come questo:

. - empty, 
T - targets for units, 
O - the place that I've choosen to move them, target for unit too
.....
.TTT.
.TOT.
.TTT.
.....

L'algoritmo Pathfinding è pronto, devo solo generare l'elenco (o vettore) dei punti target, uno per ogni unità. Non voglio il codice completo, ma solo alcuni consigli e idee ... beh, mi dispiace che non tutti i posti sono percorribili ...

Grazie per qualsiasi risposta e scusa per il mio cattivo inglese ...