Come posso filtrare il mio sistema di coordinate?

Seguendo con questo , ho un mucchio di coordinate e le disegno su un'immagine bitmap come sistema di coordinate. Ora, vorrei eliminare tutto il rumore e le coordinate del filtro per dare un percorso "più pulito" o "più pulito" e dati "meno" o "migliori" su cui lavorare. Per spiegare di più, dovrò esporre le mie fantastiche abilità di pittura come segue:

attuale:

desiderata:

Avviso:

• Potreiaverbisognodicancellarelecoordinate

• Potreiaverbisognodiaggiungerelecoordinate

• Potreidoverignorareilvicinopiùcortoinalcunicasi

L'unicacosachepossopensareèusareunalgoritmodipercorsopiùbrevecome A * e Dijkstra . E compila i dati in una sorta di struttura dati per contenere i vicini e i costi per ogni nodo e quindi per eseguire l'algoritmo. Non voglio iniziare qualcosa che potrebbe essere sbagliato o sprecare. Mi piacerebbe vedere uno pseudo codice, se possibile, su come potrei risolvere un simile problema ?

P.S Sono attualmente su Wpf C # ma sono aperto a utilizzare C # o C ++ per qualsiasi attività. Grazie